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ABSTRACT 


The  sliding  mode  control  is  known  as  a  robust  control  that  is  able  to  work  under 
the  uncertainties  of  modeling  error  and  the  environmental  disturbances.  The  objective  of 
this  research  is  to  design  the  simple  control  (sliding  control)  algorithms  for  a  single-link 
flexible  arm  and  to  study  the  robustness  due  to  varying  payload.  A  general  form  of 
physical  plant  in  state  space  is  formulated.  To  achieve  a  continuous  control,  a  time- 
varying  boundary  layer  was  introduced  into  the  control  system  neighboring  the  sliding 
surface.  The  computer  simulation  program  was  coded  in  MATLAB.  A  low-cost  IBM-AT 
micro-computer  was  utilized  to  implement  the  sliding  control  on  the  flexible  arm  system. 
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I.  INTRODUCTION 


A.  MOTIVATION 

The  control  of  flexible  arms  has  been  an  active  research  area  and  a  challenge  to 
researchers.  The  motion  control  of  flexible  arms  concerns  the  tip  position  and  the  control 
algorithm  should  be  able  to  deal  with  the  large  motion  and  the  small  motion  due  to  vibrations. 
It  is  difficult  to  have  a  precise  arm  model  and  an  error  exists  between  the  model  and  the  plant, 
that  is  modeling  error.  The  modeling  error  for  flexible  arm  may  contain  changing  payload,  high- 
frequency  unmodeled  dynamics,  deviation  on  load  position  in  the  end-effector,  and 
environmental  disturbances. 

As  the  operation  of  control  system  is  concerned,  the  computation  of  the  control  law  plays 
an  important  role.  While  the  time-delaying  may  worsen  the  control  system,  the  control  structure 
has  to  be  as  simple  as  possible  to  reduce  the  computation  time.  Since  the  models  of  flexible  arms 
are  complicated,  simplified  models  will  be  utilized  and  controllers  will  be  designed  accordingly. 

Therefore,  the  challenge  that  we  encounter  in  this  research  is  to  design  simple  control 
algorithms  such  that  the  modeling  errors  due  to  changing  payload  are  compensated  and  the  on¬ 
line  operation  will  also  be  achieved  on  the  single-link  flexible  arm.  An  IBM-AT  is  chosen  for 
the  low-cost  implementation  in  this  research. 

B.  LITERATURE  REVIEW 

The  single-link  flexible  arm  model  of  using  Equivalent  Rigid  Link  System  (ERLS)  was 
first  derived  by  Chang  [Ref.  1].  The  ERLS  described  the  motion  in  large  motion  and  small 


1 


motion.  A  Sequential  Integration  Method  [Ref.  2]  was  also  derived  to  facilitate  an  effective 
integration  routine.  Petroka  [Ref.  3]  experimentally  validated  the  ERLS  dynamic  model  of 
single-link  flexible  arm  which  was  built  and  driven  by  an  electrohydraulic  actuator.  Gannon 
[Ref.  4]  upgraded  the  model  by  using  the  natural-mode  shape  function.  Park  [Ref.  3]  designed 
and  simulated  a  closed-loop  non-robust  controller  for  the  arm.  Kirkland  [Ref.  5]  redefined  and 
implemented  the  controller  on  an  IBM-AT  computer.  A  strain  gage  and  a  potentiometer  were 
used  to  determine  the  tip  position  of  the  arm. 

As  the  robust  control  algorithm  is  concerned,  the  Sliding  Mode  Control  (SMC)  [Ref.  6-9] 
has  been  known  as  a  robust  control  that  is  insensitive  to  modeling  error  and  disturbances.  Figure 
1  illustrates  a  synthesis  view  of  the  sliding  mode  control.  The  external  disturbances  and 
parameters  variation  will  first  be  filtered  by  the  5  dynamics  to  produce  S  and  the  generated  S 
will  be  fed  into  error  dynamics  to  perform  further  filtering.  Thus,  the  S  dynamics  play  very 
important  roles  to  provide  robustness  to  the  control  system.  Once  the  S  dynamics  reject  all  the 
unwanted  signals,  the  error  dynamics  will  present  the  system  behavior.  Because  of  the 
undesirable  high  speed  switched  control  on  the  sliding  mode,  a  boundary  layer  thickness  was 
introduced  to  the  control  system  and  a  smoothed  control  was  designed.  Fan  [Ref.  10]  simulated 
and  implemented  the  sliding  mode  control  on  the  single  link  flexible  arm.  The  robustness  of  the 
control  was  proved  despite  of  a  simplified  model.  Straight  sliding  control  [Ref.  1 1]  and  versatile 
sliding  control  [Ref  12]  utilizing  the  idea  of  filtering  provide  more  tuning  capability  on  the  S 
dynamics  such  that  the  unwanted  signals  will  be  filtered.  In  this  research,  these  sliding  control 
algorithms  will  be  applied  to  the  single  link  flexible  arm  to  study  the  control  system  dynamics. 
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C.  OBJECTIVE 


The  objective  of  this  research  is  to  utilize  simple  control  structures  (sliding  mode 
controls)  to  perform  the  motion  control  of  a  single-link  flexible  arm.  The  robustness  due  to 
varying  payload  will  be  studied.  The  control  design  will  be  performed  in  a  state-space  form 
using  matrix-norm  techniques.  An  IBM- AT  will  be  chosen  for  the  implementation. 
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n.  PLANT  AND  ITS  MATHEMATICAL  MODELS 


A.  PHYSICAL  PLANT 

An  experimental  arm  is  shown  in  Fig.  2,  which  is  driven  by  an  electrohydraulic  actuator. 
The  motion  of  the  arm  is  limited  to  a  vertical  plane.  The  flexible  arm  can  bend  freely  in  the 
vertical  plane,  but  it  is  stiff  in  torsion  and  horizontal  bending.  The  arm  consists  of  two  parallel 
steel  flat  bars  welded  at  the  base  and  directly  clamped  to  the  hydraulic  actuator.  Torsional 
stiffness  is  obtained  by  connecting  the  two  steel  bars,  with  thin  steel  strips,  to  seven  transverse 
steel  bridges.  Table  1  shows  geometric  and  mass  properties  of  the  flexible  arm. 

Table  1 


Arm  Length 

0.9985  m 

Arm  Mass 

4.8565  kg 

Transverse  Rigidity 

81.3  N  m^ 

Arm  Cross-Sectional  Area 

6.178x10^  m^ 

Density 

7861.05  kg/m^ 

A  potentiometer  is  used  to  measure  the  actuator  Qarge  motion)  signal.  A  two-arm  bridge 
strain  gage  attached  to  the  center  of  the  arm  is  used  to  calculate  the  tip  deflection  (small  motion) 
of  the  arm.  Data  acquisition  was  performed  using  a  high  speed  Data  Translation  interface  board 


DT  2821-F-8DI,  which  was  installed  in  a  micro-computer  (standard  IBM-PC  AT).  The  support 
software  (AT-LAB)  allowed  direct  manipulation  of  the  data  acquisition  board  through  the  use 
of  provided  subroutines  which  are  compatible  with  FORTRAN. 


Figure  2  A  Single-Link  Flexible  Manipulator  System 


B.  MATHEMATICAL  MODEL  OF  THE  PLANT 

In  this  section,  a  mathematical  model  of  the  plant  is  given,  which  includes  an  ERLS 
(Equivalent  Rigid  Link  System)  dynamic  model  of  the  arm  and  actuator  dynamics. 

1.  AN  ERLS  DYNAMIC  MODEL  OF  FLEXIBLE  ARM 

The  ERLS  is  defined  as  a  hypothetical  system  which  produces  the  large  motion 
and  whose  kinematics  are  equivalent  to  a  rigid-link  system.  An  ERLS  of  a  planar  manipulator 
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with  single  link  is  shown  schematically  with  the  dash  line  in  Figure  3,  where  geometric  center 
line  of  link  was  drawn.  The  solid  lines  stand  for  the  deformed  state  of  the  arm.  The  ERLS  of 
a  flexible  arm  describes  the  large  motion  of  the  arm,  and  then  the  small  motion  arising  from  the 
structure  flexibility  can  be  superimposed  on  the  ERLS  [Ref.  U 

The  ERLS  dynamic  model  of  the  arm  was  developed  by  means  of  Lagrange’s 
formulation,  the  Finite  Element  Method,  and  the  ERLS  kinematics.  To  apply  the  Lagrangian 
dynamics  to  the  flexible  arm,  the  generalized  coordinate  (Figure  3)  is  chosen  to  describe  the 
large  motion  by  joint  variable  0.  The  Finite  Element  Method  is  utilized  to  discretize  the 
displacement  such  that  the  small  motion  is  represented  in  terms  of  nodal  displacement  u  ,  where  u 
is  the  tip  deflection.  In  this  study,  the  natural  mode  shape  functions  of  a  beam  are  used  to 
represent  the  flexural  motion  of  the  flexible  arm,  and  the  arm  is  modeled  as  a  continuous  Euler- 
Bemoulli  cantilever  beam,  neglecting  shear  deformation  and  rotary  effects.  [Ref.  4] 
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2. 


EQUATIONS  OF  MOTION  OF  FLEXIBLE  ARM 


Lagrange’s  equations  for  the  flexible  manipulator  are 


d,dKE.  dKE  dPE 
dt  dq.  dq.  dq. 


i=U. 


(2.1) 


where  KE  and  PE  are  kinetic  and  potential  energies,  q^  ’s  are  the  generalized  coordinates  and 
are  defined  by 

[qi  gjl  -  [0  v>]  (2-2) 


GF’s  are  generalized  forces.  For  the  system  without  applied  forces  at  the  end  effector,  the 
generalized  force  vector  is  given  as 

GF  =  [GF,  GF^V  =  [T  0)^  (2.3) 

where  7  is  an  applied  torque  at  the  joint.  [  ^  represents  the  transpose  of  the  matrix. 

The  total  kinetic  energy  has  three  parts,  i.e.,  the  kinetics  energy  of  the  arm  (KE) , 
the  rotor  of  the  actuator  (KE) ,  and  the  payload  (KE)) .  The  mathematical  expressions  of  these 
energies  are 

KE.  =  -  f  r/  r,  dm  (2.4) 
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(2.5) 


KE. 


—  Trace  f  f^r^.  dm 

2  Jrctor  '  ' 


and 


KE=-  Trace  f 
p  ')  J, 


r„  r‘ 

paytoad  P  P 


dm 


(2.6) 


where  r  is  the  velcx:ity  of  a  differential  mass,  the  subscripts  I  ,  r,  and  p  are  for  the  link,  the 
rotor,  and  the  payload,  and  dm  is  the  differential  mass.  Note  that  applying  the  Trace  operator 
on  the  kinetic  improves  the  computational  efficiency  for  the  rigid-body  modeling  since  time- 
invariant  terms  can  be  separated  from  time-variant  terms  through  the  operator. 

The  potential  energy  comes  from  strain  energy  and  gravitational  energy.  The 
mathematical  expressions  are  given  as 


PE. 


=  -/ 
1  Jm 


Imk  ® 


(-7)  dx 
dx^ 


(2.7) 


and 

PE  =  -  f  rj  g  dm  -  f  rl  g  dm  (2.8) 

»  J  UKk  ‘  J  payload  ' 


where  EI^  is  the  bending  rigidity  in  the  xy  plane,  g  is  a  gravitational  acceleration  vector. 
According  to  the  inertial  coordinates  in  Figure  3,  the  gravitational  acceleration  is  defined  as 
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g  =  [0  0  -9.80]^  (m/sec^) 


(2.9) 


KE  and  PE  are  expressed  in  terms  of  the  generalized  coordinates  .  The  absolute  positions  and 

velocities  in  Equation  (2.4)-(2.8)  are  formulated  by  the  kinematics  of  the  ERLS.  [Ref.  1] 

Two  sets  of  equation  of  motion  for  a  single-link  flexible  manipulator  are  obtained 
from  the  derivation  of  above,  which  are  nonlinear,  coupled,  second-order,  ordinary  differential 
equations  represented  as  follows, 

*  «®t,«  = /e 

where  u  represents  the  nodal  displacement,  and  are  effective  masses  for  the  large 

motion  and  small  motion,  and  m^g  are  coupled  masses  between  large  and  small  motion, 

is  gyroscope  for  small  motion,  is  stiffness  for  small  motion,  and  /g  and  are 

load  for  large  and  small  motion.  The  effective  and  coupled  masses,  the  gyroscopic  matrix,  and 
load  are  nonlinear  in  e  or  0  .  In  order  to  separate  the  applied  torque  from  other  terms  in  /g 

,  let  fg  =  hg  ^  T.  [Ref.  3]  In  this  study,  a  motion  control  is  designed  to  control  the  tip  position 

of  the  arm.  With  a  small  deflection  assumption,  the  tip  position  can  be  approximated  and 
represented  by  a  total  angle  (p  ,  where  <p  =  0  +  vfL-  The  control  design  therefore  requires 
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a  mathematical  model  for  the  total  angle.  Equations  (2.10)  and  (2.11)  can  thus  be  rewritten  into 
an  explicit  form  for  the  applied  torque  as  follows, 

">66®  '"en®  =  *  T  (2-12) 


Since 


Equations  (2.12)  and  (2,13)  can  further  be  rearranged  in  terms  of  the  total  angle  as 

®  2"  (2.14) 


^neV  +  -  m  JL)v  +  g  i)  +  k  v  =  ^ 


(2.15) 


From  Equations  (2.14)  and  (2. 15),  an  uncoupled  equation  for  the  total  angle  (p  is  obtained  by 
eliminating  the  small  deflection  u  as  follows, 

IV  <p  +  =  7  (2.16) 


where 
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N  =  D 


F,  =  (2.17) 

D  =  ~  ”»ee/^ 

3.  ELECTROHYDRAULIC  ACTUATION 

The  flexible  arm  is  driven  by  an  electrohydraulic  actuator  of  which  the  dynamics 
is  an  integral  part  of  the  total  system  model.  The  dynamics  of  the  electrohydraulic  actuator 
include  servovalve  dynamics  and  hydraulic  motor  dynamics.  A  simplified  description  of 
servovalve  dynamics  was  provided  by  MOOG,  the  manufacturer  of  the  servovalve.  A  single 
equation  which  presents  the  dynamics  is  given  as 

(2.18) 


where  Q  is  the  flow  delivered  from  the  servovalve,  /C  is  a  valve  sizing  constant  which 
contributes  to  hydraulic  system  damping.  7  is  an  input  current,  and  is  the  valve  pressure 

drop,  i.e.,  P^  -  Pi,  where  P^  is  the  supply  pressure  and  is  the  load  pressure  drop. 

Motor  dynamics  consists  of  a  form  of  continuity  equation  and  the  torque  output 
equation  [Ref.  13].  They  are  written  as  follows 

Vz  -  (2- 19) 
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and 


D,  (2-20) 

where  is  the  motor  displacement,  is  the  leakage  flow  in  the  motor,  (K,  /  4p^)P^  is 

the  compressibility  flow,  and  is  the  torque  efficiency.  A  detail  account  for  the  selection  of 
hydraulic  component  for  the  system  was  included  in  [Ref.  3]. 

C.  STATE  SPACE  REPRESENTATION 

Considering  the  plant  dynamic  model.  Equations  (2.16)  through  (2.20),  these  equations 
can  further  be  rearranged  as 

N(p  +  P,  =  (2.21) 

and 

Dji  .  C^Pl  • 

Differentiating  Equation  (2.21) 

Nip  +  Nip  + 

Equation  (2.21)  and  (2.22)  can  be  rewritten  as 
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(2.24) 


\ki^.-d^Q-c^p,) 


'  1  ^ 


r)p.l 


{Nip  .  F,) 


(2.25) 


Substituting  Equations  (2.25)  into  Equation  (2.24),  and  then  substituting  Equation  (2.24)  into 
Equation  (2.23)  give 

»  -  V  -  /o  (2,26) 


where 


vp  \ 


N^  ■>-  F^ 


Vp  N  Vp 

[W  K,  j 

Note  that  Equation  (2.26)  is  a  time-varying,  nonlinear  third-order  ordinary  differential  equation 
represented  in  scalar  form. 

In  this  study,  the  state  space  representation  of  Equation  (2.26)  will  be  used  for 
the  control  action  and  the  representation  is  given  as  follows 
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X  =  Bu 


(2.27) 


where 


^  =  [  <p  4)  (p 

B  =  [0  0  bf 
u  =  I 

/  =  [  <P  V  /o 


The  representation  of  Equation  (2.27)  will  be  used  for  the  development  in  the  control  techniques. 
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m.  CONTROLLER  DESIGN  (SLIDING  MODE  CONTROL) 


A.  INTRODUCTION 

For  many  control  system  design  problems,  the  designers  do  not  have  a  detailed  state- 
space  model  of  the  plant  to  be  controlled,  either  because  it  is  too  complex,  or  because  its 
dynamics  are  not  completely  understood.  No  nominal  model  should  be  considered  complete 
without  an  assessment  of  its  errors.  These  errors  are  refereed  to  as  modeling  uncertainties  of  the 
system.  Therefore,  a  robust  control  design  was  attempted  such  that  the  control  system  will  be 
insensitive  to  the  modeling  uncertainties. 

Based  on  our  knowledge  of  physical  mechanisms  which  cause  differences  between  model 
and  plant  and  our  ability  of  representing  these  mechanisms,  the  representations  of  uncertainties 
may  vary  in  terms  of  the  structure  they  have.  In  practice,  it  is  possible  to  represent  these  error 
in  a  highly  structured  parameterized  form.  These  are  usually  the  low  frequency  components.  For 
a  manipulator  system,  these  parametric  uncertainty  or  structured  uncertainty  may  come  from  the 
imprecision  on  the  manipulator  mass  properties,  unknown  loads,  uncertainty  on  the  load  position 
in  the  end-effector,  and  inaccuracy  on  the  torque  constants  of  the  actuators.  However,  there  are 
always  remaining  higher  frequency  errors  in  the  systems,  which  can  not  be  covered  in  the 
parameter  uncertainties.  Also,  these  high  frequency  unmodeled  dynamics  is  referred  to  as 
unstructured  uncertainties.  These  unstructured  uncertainties  are  usually  caused  by  unmodeled 
structural  modes,  neglected  time-delays  in  the  actuators,  or  finite  sampling  rate. 

The  greatest  challenge  of  designing  a  robust  controller  is  not  only  to  minimize 
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performance  sensitivity  to  uncertainties  due  to  system  parameters  but  also  not  to  excite  the  high 
frequency  unmodeled  dynamics.  The  Sliding  Mode  Control  has  been  known  as  a  robust  control 
that  is  able  to  work  under  the  confined  uncertainties  of  dynamic  modeling  error  and 
environmental  disturbances.  The  concepts  of  the  SMC  derived  from  the  Variable  Structure 
Control  have  been  extensively  studied  in  the  Soviet  Union  for  more  than  two  decades.  The  SMC 
utilizes  a  high-speed  switching  control  law  to  drive  the  plant’s  state  trajectory  toward  a  specified 
surface  (the  sliding  surface)  and  to  maintain  the  plant’s  state  trajectory  on  this  surface. 

The  SMC  using  output  models  involves  two  filters,  i.e.,  S  dynamics  and  error  dynamics. 
The  S  dynamics  was  designed  to  filter  the  uncertainties  and  the  error  dynamics  was  designed  to 
obtain  system  error  e.  Figure  1  illustrated  the  sliding  algorithm  from  the  filter  point  of  view,  and 
also  the  control  system  block  diagram  is  shown  in  Figure  4.  Since  a  high-speed  switched  control 
about  the  sliding  surface  is  not  favorable  to  mechanical  systems,  a  boundary  layer  thickness  was 
introduced  into  the  SMC  such  that  a  smoothed  control  is  achieved. 

In  this  chapter,  three  sliding  mode  controls  will  be  presented,  which  includes  the  sliding 
control  with  a  first-order  sliding  condition,  the  straight  sliding  control,  and  the  versatile  sliding 
control.  Before  presenting  the  control  algorithms,  the  uncertainties  and  the  sliding  surfaces  will 
first  be  described. 
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Figure  4  Block  Diagram  of  Sliding  Mode  Gmtrol 


SYSTEM  EQUATIONS  AND  CONFINED  UNCERTAINTIES 
From  Chapter  II,  the  dynamic  equation  of  a  flexible  single-link  arm  was  written  as 

X  =  Bu  *f  ^ 

X  =  [XjX2 

«  =  [  II  ] 

/  =  [/.  fz  /a  r 


B^[B,  B,  B,  f 


Note  that  B  and/  are,  in  general,  nonlinear  functions  of  ou^ut  variables  and  time.  Equation 
(3.1)  can  be  seen  as  a  canonical  form  of  physical  models  for  nonlinear  time- varying  dynamical 
systems. 

To  control  system,  a  nominal  mathematical  model  of  the  system  can  be  obtained  as, 

X  ^  Bu  *  }  (3-2) 

£  and  ^  are  the  nominal  values  of  B  and  /,  which  can  be  estimated  from  the  theoretical 

evaluations  or  experiments.  Due  to  parameter  uncertainty,  the  discrepancies  between  the  model 
and  the  physical  plant  are  specified  by  aB  and  a/,  where 

AB  >  B  -  i  (3  3) 

A/  ./-  / 

The  sliding  control  assumes  that  uncertainties  and  disturbances  are  bounded.  The 
uncertainties  associated  with  the  model  are  confined  as 

lABI  4  p  (3  4) 

lAf  I  i  Y 

where  I*]  denotes  a  norm  of  •  which  is  a  vector  or  a  matrix.  Note  that  in  this  study  the  norm 
of  A  .  for  instance,  is  defined  as 

IA|  =  v/TWA’SC  0-S) 
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where  [eigi*)]^  stands  for  the  maximum  eigenvalue  (i.e.,  the  spectral  radius)  of  • .  This  matrix 

norm  is  called  the  spectral  norm  and  the  corresponding  vector  norm  is  called  Euclidean  vector 
norm.  The  confining  parameter  p  and  y  can  be  found  as 


(3.6) 


where  the  components  of  (or  •^)  are  the  maximum  (or  minimum)  values  of  the 

corresponding  components  of  • .  It  is  noted  that  p  and  y  are  non-negative  numbers.  It  also 
implies  that  the  system  parameters  and  their  nominal  values  are  related  as 


A 

B  = 


^BMK  •^min 

2 

f  +  /  • 

JmMX  i/miD 


(3.7) 


The  greatest  value  of  confmement  of  AB  is  defined  as 

(AB)^  =  B^  -  B 


(3.8) 
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C.  SLIDING  SURFACES 


In  this  single-link  flexible  arm  study,  sliding  surface  will  only  have  one  because  of  one 
control-input.  The  sliding  surface  is  defined  to  be  S  =  0  where  s  is  a  sliding  variable.  The 
sliding  variable  directly  relates  the  system  error  as 

S  =  «  (3.9) 


where 

S  =  I  s,  ] 
e  =  [  «,  e,  e,  f 
*  .  [  r,  r,  r,  f 

e  is  the  tracking  error,  i.e.,  e  -  X  ~  X^,  where  Xj  is  a  desired  output  vector,  and  is  defined 
as 

~  f  ^Id  ^2d  ^ 

R  is  to  locate  the  poles  of  the  error  dynamics  on  the  sliding  surface.  S  can  be  interpreted  as  an 
input  to  the  error  dynamics,  and  the  error  is  a  filtered  version  of  S. 

An  integral  control  can  be  introduced  into  sliding  surface  to  eliminate  steady-state  error 
as  follows. 
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(3.10) 


where 


G  «2  Si  I’' 


Note  that  once  the  poles  for  each  sliding  surface  were  assigned,  the  R  and  G  are  both  constant 
vectors. 


D.  SLIDING  CONTROL  WITH  A  FIRST-ORDER  SLIDING  CONDITION 

The  relationship  between  control  input  u  and  S  dynamics  can  then  be  obtained  by 
differentiating  Equation  (3.10) 


S  ^  i  *  e 


(3.11) 


Since 


X  =  Bu  *f 
e  =X-X^ 


Equation  (3  11)  can  be  rewritten  as 

S  =  R\Bu  *  f  -  XJ)*  G^e  (3.12) 


The  role  of  the  control  input  u  is  to  control  the  S  dynamics  such  that  the  sliding  surfaces  can 
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be  reached  within  a  finite  time.  Once  the  sliding  surface  is  reached,  zero  steady-state  tracking 
can  thus  be  achieved  on  the  sliding  surfaces  provided  the  error  dynamics  is  stable. 

The  Lyapunov  stability  criterion  is  used  to  derive  a  sliding  condition  which  specifies  the 

S  dynamics.  A  Lyapunov  function  V  is  picked  such  that  V  =  —  S^S .  By  applying  the  Lyapunov 

2 

stability  criteria,  K  ^  0  >  ^  sliding  condition  is  written  as 

S^SiO  (3.13) 

The  sliding  condition  assures  the  attractiveness  of  the  S  dynamics  toward  the  sliding  surfaces. 
To  be  able  to  adjust  the  sliding  speed  5,  Equation  (3.13)  is  rewritten  as 

S  i  -^\S\  (3-^^) 

where  q  is  a  non-negative  real  number.  It  is  worth  to  note  that  Equation  (3.14)  is  a  first-order 
sliding  condition. 

The  sliding  condition  specifies  a  desired  dynamics  of  S  on  which  S  slides  toward  the 
sliding  surfaces  and  the  steady-state  error  can  be  eliminated.  To  obtain  the  desired  S  dynamics, 
the  control  input  can  be  designed  using  predictor-corrector  scheme  as 

u  =  -  k  sgniS))  (3- 15) 

where  u,  i.e.,  nominal  control  input,  can  be  obtained  by  letting  5=0.  which  will  give 
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fi  =  Jf  -  /)  -  G^e 


(3.16) 


Also, 


s^(5)=  [  sgn(s^)  ] 


1  5j^0 

-1  s,<0 


Note  that  (R^B)  a  scalar.  Also,  note  that  (r^by^A  is  a  predictor  and  (R'l^sy^k  sgn(S)  is  a 

corrector.  The  gain  it  is  a  non-negative  real  number  and  is  determined  by  using  matrix-norm 
techniques.  By  substituting  Equation  (3.12)  into  Equation  (3.14),  an  inequality  will  be  given  as 

i  -qlSIt  (3.17) 

The  control  input  (Equation  (3. 15))  can  then  be  substituted  into  Equation  (3.17),  which  will  give 
5'[(/?^B)(/f^i)-*(fi-ife  «gn(5))+il'’(f-;f^)+G^<]i-Ti|S||  (3.18) 

Also,  Equation  (3.16)  will  give 

=  &  *  R^f  *  G^e 

Substituting  into  Equation  (3.18)  and  rearranging  give 

{j?V-/)-^[(/J^W^B)-'-/]ii-(/?^B)(/J^B)-^)A:  sgniS)}i~j]\S\\  (319) 

The  uncertainties  described  in  Equation  (3.3)  are  applied  to  Equation  (3.19)  and  the  sliding 
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condition  is  given  as 


5gniS)}i-r] iS|  (3.20) 


In  order  to  quantify  gain  k,  the  matrix-norm  technique  is  applied  to  Equation  (3.20)  and 


S  ^AMR  ^AB)iR  -[MR  ^AB)(R  '■i)-‘]fc  jgn(S)} 

i|SH|/Jl(|A/lHAB||(/f^B)  *tf|)-i(l-|lfAB«l(lJ»^B)-WS)a)} 


(3.21) 


Note  that 


-kS^iR^AB)iR%-^sgn(S)  s  k\Sl[RAB\\iR^B)-^sgniS)\ 


-kS^sgniS)  s  -ifcllSI 


and 


\R^AB\  =  \R^(AB)^[ 


Therefore, 


\S\{\RK\Af\^\AB\KR^B^  ^ii\)-k(\-lRAB\\iR^B)  'sgn{S)\}^  i]\S\  (3  32) 


Because  of  the  uncertainty  confinements  (Equations  (3.4)  and  (3.6)),  Equation  (3.22)  becomes 
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(3.23) 


Finally,  the  gain  k  is  found  as 

m(y^mR^Br^u\)*r^  (3  24) 

l-UfA5||||(i2’'i)-'s^(S)l| 

As  stated  before,  the  gain  jt  is  a  non-negative  number.  Thus,  a  sufficient  condition  is  given 

1  >  \\RABU(R^Br^sgn(S)\  0-25) 

The  Lyapunov  stability  is  guaranteed  as  long  as  the  gain  k  is  chosen  according  to  Equation 
(3.24).  For  control  design  purposes,  the  minimum  value  of  k  is  selected  since  the  least  control 
effort  is  desired.  Because  of  the  discontinuity  of  the  sgn  functions,  the  control  is  called  switched 
control  and  causes  chattering,  which  is  unfavorable  to  the  mechanical  devices.  Equation  (3.15) 
can  be  substituted  into  Equation  (3.12)  to  obtain  the  S  dynamics  as  follows 

S^k(R^BXR  ^By^sgniSj  =R  -{R  ^^B)iR  ^BY^u  (3-26) 

It  is  observed  that  the  right-hand-side  of  Equation  (3.26)  consists  of  uncertainties,  error,  and 
desired  trajectory  dynamics,  which  are  the  excitations  to  the  S  dynamics  and  are  to  be  filtered 
out  by  the  first-order  S  dynamics. 

To  smooth  the  control  law,  a  boundary  layer  with  thickness  ^  is  introduced  where  the 
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thickness  is  a  real  positive  number.  Outside  the  boundary,  |Sj  |  ^4) ,  the  control  law  u  is  designed 

to  satisfy  the  sliding  condition,  Equation  (3. 14),  which  guarantees  boundary  layer  attractiveness. 
Inside  the  boundary,  |s,|«j),  the  control  law  will  impose  a  smoothing  process  to  the  S 

dynamics.  The  general  law  is  written  as 

u  =  -  k 

where 

-f)  -  G^e 


The  sat  function  is  defined  as 

<p  I  9  J 

.  ♦ 


kil^9 
ki  l<4> 


The  S  dynamics  of  Equation  (3.26)  is  smoothed  within  the  boundary  layer,  i.e., 

S*-iR^B)(R  ^Br^S=R  ^(f-f)-iR  ^^B){R  ^By^u  (3.28) 

9 


Equation  (3.28)  represents  a  first-order  low-pass  filter.  The  boundary  layer  thickness4) 
determines  the  response  speed  of  the  S  dynamics  and  the  values  of  <j)  can  be  either  constant  or 
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time- varying. 


To  obtain  a  time-varying  thickness,  a  maximum  bandwidth  is  assigned  to  the  S 

dynamics  within  the  boundary  layer  (Equation  (3.28)).  The  analytic  properties  of  matrix-norm 
are  to  be  used  to  quantify  the  bandwidth.  The  spectral  radius  of  the  bandwidth  is  defined  as 

X  =  -(R^B)(R^B)-^ 

<l> 


Thus,  the  boundary  layer  thickness  <(>  is  designed  such  that  Also, 


Therefore, 


-(R^B)(R^By^i  -  ^R^B){R^By^\ 
<t>  4> 


(3.29) 


X  i  ~  \iR^B)(R^By^\ 
4> 


(3.30) 


Since 


|(iJ^J?)(/?^B)-'||  s  l  +  !|i?A5||(IJ^i)-‘|  (3-31) 


and  by  the  confinements  of  uncertainty  (Equation  (3.3)),  the  spectral  radius  is  then  found  as 

xAu\RAB\\m^By^\) 

<P 
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Hence,  the  maximum  bandwidth  can  be  assigned  as 


<p 

Therefore,  the  thickness  <{)  is 

4)  =  (3.32) 

In  the  Equation  (3.32),  the  maximum  baridwidth  determines  the  boundary  layer  thickness<j) 

which  controls  the  tracking  accuracy  and  response  speed.  By  selecting  a  proper  value  of  X^ , 

Equation  (3.32)  can  assure  that  bandwidth  will  never  exceed  X^,, . 

In  summary,  the  sliding  control  with  first-order  sliding  condition  is  designed  to  have  both 
5  dynamics  and  error  dynamics  low-pass  filters  where  an  integral  error  can  be  added  on  error 
dynamics  to  eliminate  the  steady-state  error.  The  S  dynamics  is  a  first-order  low-pass  filter,  in 
which  the  uncertainties  are  filtered.  A  detailed  synthesis  view  of  5  dynamics  of  sliding  control 
with  a  first-order  sliding  condition  is  shown  in  Figure  5.  The  continuous  control  of  Equation 
(3.26)  can  be  used  to  replace  the  switching  control  and  eliminates  the  chattering.  A  detailed 
block  diagram  of  sliding  control  system  is  illustrated  in  Figure  6. 
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Hgiire  5  A  Detailed  Synthesis  View  of  Sliding  Mode  Control  with 
First-Order  Sliding  Condition 


RXd 


Figure  6  A  Detailed  Block  Diagram  of  Sliding  Mode  Control  with 
First-Order  Sliding  Condition 
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E.  STRAIGHT  SLIDING  CONTROL  WITH  FIRST-ORDER  PLUS  INTEGRAL 
SLIDING  CONDITION 

The  straight  sliding  control  begins  with  the  same  sliding  surface  which  was  defined  in 
Equation  (3.9).  By  differentiating  Equation  (3.9),  the  relationship  between  control  input  and  S 
dynamics  can  be  found 

S  =  R^(Bu  *  f  -  (3.33) 


The  Lyapunov  stability  criterion  will  be  used  to  derive  straight  sliding  condition  and 
specify  the  desired  S  dynamics  such  that  the  sliding  condition  can  be  reached  in  a  finite  time. 
A  Lyapunov  function  is  defined  as 


(3.34) 


By  applying  the  Lyapunov  stability  criterion,  k  ^  o»  the  sliding  condition  is  obtained 


(3.35) 


Equation  (3.35)  indicates  that  a  first-order  plus  integral  sliding  condition  representing  a  stability 

criterion  for  an  equivalent  mass-spring-damper  system  in  which  ('s  dt  is  a  equivalent 

Jo 

displacement.  The  dt  provides  an  additional  restoring  effort  and  the  dynamic  behavior 
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can  thus  be  tuned  by  the  equivalent  spring  constant  .  Furthermore,  Equation  (3.35)  can  be 
written  as 

dr)i-Ti|Sl|  (3.36) 

"  Jo 

where  t|  is  a  positive  real  number.  The  sliding  condition,  Equation  (3.36),  describes  a  desired 
S  dynamics  on  which  S  slides  toward  the  sliding  surface. 

In  order  to  obtain  the  desired  S  dynamics,  the  control  input  can  be  obtained  as 

u  =  -  iksgn(S))  (3.37) 

where  it  is  obtained  by  letting 

a  ^  R^Bu  =  R\X^-h-^^^Sdt  (3.38) 

The  gain  k  is  determined  by  substituting  Equation  (3.33)  into  Equation  (3.36),  which  gives 

S  '(a  \Bu  Sdtji  -T]  |S|  (3.39) 

Equation  (3.39)  can  be  further  simplified  by  using  Equation  (3.37)  and  Equation  (3.38), 

S^{R'^^MR^£iB)(R^Br^u-[lHR^£iB)iR^By'^^  sg7i(S)}i-TillS|  (3-40) 
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It  is  noted  that  Equation  (3.40)  has  exactly  the  same  form  as  Equation  (3.20)  has.  Thus,  the 
same  matrix-norm  techniques  used  in  Equations  (3.20-25)  will  be  utilized  to  quantify  the  gain 
k,  which  gives 


ki: 


(3.41) 


The  S  dynamics  can  be  formed  in  terms  of  uncertainties  by  substituting  Equations  (3.37- 
38)  into  Equation  (3.33),  which  gives 


S^k(R^B){R^Br^sgniS)HR^B)(R^Br^u>^^fsdt 

-{iR^B)iR^By^-I^^X^*R^f-(R^B)iR^By^R^/ 


The  right-hand-side  of  Equation  (3.42)  represents  the  excitations  to  the  S  dynamics,  which 
consist  of  the  desired  trajectory  dynamics,  uncertainties,  and  disturbances.  In  other  words,  the 
S  dynamics  can  be  treated  as  a  filtered  version  of  excitations  and  filter  out  most  unwanted 
uncertainties  and  disturbances.  The  sgn  function  causes  chattering  which  will  produce 
undesirable  noise  and  mechanical  wear.  A  continuous  control  is  then  developed  to  eliminated 
chattering. 

A  boundary  layer  with  thickness  4>  is  introduced  to  smooth  out  S  dynamics.  The  control 
algorithm  is  defined  as 

«  =  (lJ^B)-'|fi  -  it  sfl/(^)j 

where 
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6  =  dt 


<P  .  9  . 


«n(^) 

4> 


5l|5t4> 


kil<4> 


Thus,  a  smoothed  first-order  low-pass  S  dynamics  can  be  obtained  as 


(3.43) 


The  S  integral  introduces  an  integral  control  to  the  S  dynamics  and  guarantees  a  zero  steady- 
state  values  of  S  which  will  drive  the  steady-state  error  dynamics  to  zero. 

From  Equation  (3.43),  the  maximum  bandwidth  is  assigned  to  S  dynamics  within 

the  boundary  layer.  The  analytic  properties  of  matrix-norm  are  to  be  used  to  quantify  the 
bandwidth.  The  bandwidth  (A,)  is  defined  as 


>}  =  («*B)(J?'fi)-^w  2 


Therefore, 


(3.44) 
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(3.45) 


Since, 


MR^BXR^BYH  s  1  +  8BAB||(B^B)-‘|  (3  46) 


The  bandwidth  is  then  found  as 

i  (l+IBABj KB *■£)-*!) (3-47) 


Hence,  the  maximum  bandwidth  is 

=  (1-^U^AB||(B'’B)-M)«,"  (3.48) 

Since  the  maximum  bandwidth  has  been  chosen  such  that  the  bandwidth  of  the  5  dynamics  will 
never  exceeds  and  the  unmodeled  dynamics  can  be  filtered.  From  the  damping  of  Equation 

(3.43)  and  also  J?  =  AB  +  B 

-(B''B)(B*’^-‘  =  -[(B*’AB)(B*'B)+l] 


Also, 


-[(B^AB)(B^J5)-‘  +  l]  i  -(B*'AB)(B’’B)-* 
9  <t> 


Therefore,  a  lower  bound  of  damping  is 


(3.49) 
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(3.50) 


<P 


Note  that  (r^B)  scalar.  Thus, 


C/  = 


(R^ABXR^B)-^ 


(3.51) 


k,  is  replaced  by  ,  which  gives 


^  zrr^m^BKR^B)-^ 


(3.52) 


Hence,  a  more  conservative  lower  bound  of  damping  is  obtained  as 


l(RAB)(R^By^ 


Therefore,  the  thickness  <)>  is. 


4,  = 


f  k  \ 


i2C,X_j 


iRAB){R^B) 


rm-i 


(3.53) 


^nua  given  by  Equation  (3.48),  where  the  spring  constant  is  the  only  control  parameter 
for  the  bandwidth.  Once  is  determined,  another  tuning  parameter  can  be  properly 
adjusted.  It  is  shown  in  Equation  (3.53)  that  also  governs  the  activeness  of  S  dynamics  where 
the  activeness  refers  to  the  magnitude  level  of  S  response.  The  greater  is,  the  thinner  the 
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boundary  layer  thickness  <{)  is,  and  the  less  active  of  5  dynamics  is.  Also,  the  less  active  5 
dynamics  has  less  influence  over  to  the  error  dynamics.  However,  the  thinner  boundary  layer 
may  require  higher  sampling  ratio  to  eliminate  the  chattering. 

In  summary,  the  straight  sliding  control  is  designed  to  have  two  lower-pass  filters  in 
which  S  dynamics  is  designed  as  a  first-order  low-pass  filter  with  an  integral  of  S  .  Figure  7 
shows  a  detailed  synthesis  view  of  straight  sliding  control  system.  The  integral  of  S  provides  an 
ability  to  make  the  steady-state  value  of  5  to  zero,  and  the  steady-state  error  will  be  driven  to 
zero.  The  straight  sliding  control  provides  two  independent  tuning  parameters  to  adjust  the  S 
dynamics.  The  tuning  parameter  of  spring  constant  provides  a  restriction  to  the  bandwidth 

of  S  dynamics  which  the  unstructured  uncertainties  (unmodeled  dynamics)  will  be  rejected.  In 
addition,  the  gives  a  fine  tune  on  the  thickness  of  boundary  layer.  Figure  8  show  a  detailed 

block  diagram  of  straight  sliding  control  system. 

F.  VERSATILE  SLIDING  CONTROL  WITH  SECOND-ORDER  SLIDING 
CONDITION 

The  idea  of  versatile  sliding  control  is  to  use  a  low-pass  S  dynamics  filter  to  filter  out 
unwanted  high-frequency  noises  that  include  unmodeled  dynamics  and  uncertainties,  and  then 
followed  by  a  high-pass  (or  band-pass)  error  dynamics  filter. 

In  order  to  make  error  dynamics  a  high-pass  filter,  an  additional  zero  is  placed  into  the 
error  dynamics.  Thus,  the  error  dynamics  is  modified  to  be 
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Figure  8  A  Detailed  Block  Diagram  of  Straight  Sliding  Control 
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S-*-zS=R^€+G^jedt 


(3.54) 


z  is  a  scalar  where  a  zero  is  assigned  for  sliding  surface.  The  relationship  between  input  control 
and  S  dynamics  can  be  found  by  differentiating  Equation  (3.54),  which  gives 

S^2S=R\Bu*f-X^*G^e  (3-55) 


Now,  Equation  (3.55)  is  a  second-order  form  of  sliding  condition,  which  specifies  S  dynamics 
in  order  to  reach  sliding  surface.  Thus  a  Lyapunov  function  to  suit  the  second-order  sliding 
condition  is 

V  =  -S^S+-S^Q  (3.56) 

2  2 


By  differentiating  Equation  (3.56)  and  imposing  sliding  speed  parameter,  the  Lyapunov  stability 
criteria  becomes 

S^(S+Q,^S)s-TilS|  (3.57) 

where  sliding  speed,  t]  ,  is  a  positive  real  number. 

According  to  the  second-order  sliding  condition,  the  switched  control  law  will  be 

u  =  iR'^By\ii  -  k  5gn(^)  (3-58) 

where  the  nominal  can  be  obtained  by  letting  s  +  =  0 
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ii  =R\X.-f) -G^e+zS-o) 


(3.59) 


and  the  gain  k  can  be  found  based  on  the  same  knowledge  as  before.  Substituting  Equation 
(3.55)  into  Equation  (3.57)  and  further  simplifying  by  Equation  (3.58)  and  Equation  (3.59)  give, 

S^{l?^A/+(iJ^AB)(iJ^i)-*<2-[l  +(«’^AB)(B^B)-‘]ifc  sgn(^}i-Ti  1S1| 


Applying  the  matrix-norm  technique,  the  gain  k  can  be  found  as 


|B||(Y-^PI(B^B)->«|)^ri 


i-mBwm^Byhgnm 


(3.61) 


Because  of  chattering,  the  switched  control  law  is  modified  to  be  a  continuous  control  law  as. 


II  =  -  *  solf.^) 


(3.62) 


Outside  the  boundary  layer,  the  control  law  is  governed  by  Equation  (3.58).  While  inside  the 
boundary  layer.  Equation  (3.62)  governs  the  control  law.  Thus,  the  definition  of  sat  function  is 
defined  as 


sa/(-^)  =  sat{^) 
9  9 


9 


k,  1<4> 
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The  continuous  5  dynamics  can  then  be  obtained  by  substituting  Equation  (3.59)  and  Equation 
(3.62)  into  Equation  (3.55) 

1<P  J  (3.63) 

=R^f-iR^B)iR^Br^R^f  +l(R^B)(R^By^  -/]U%+[/-(J?^B)(/i^J5)-‘]G^« 


To  find  time-varying  boundary  layer  thickness,  the  maximum  bandwidth  is  first  to  be  evaluated 
as  in  the  section  D  (straight  sliding  control), 


=  (l^flUAB||(J?’'i)-‘|)o  2 


(3.64) 


The  damping  of  5  dynamics  is 


^{R^B){R^6)-^  +  {l-iR^BXR^&y^)z 
=  ^{iR^^BXR^&)-^*l)  -  (R^ABXR^&yh 

V 


(3.65) 


Also, 


4((B^AB)(/l''B)-^+l)  -  {R^^B){R^By\ 
V 

i  ^iR^^B)(R^By^  -  (R^ABXR^Byh 
<P 


(3.66) 


Therefore,  a  lower  bound  of  damping  is  obtained 
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(3.67) 


2C,X,  =  -(«^AB)(J? *■«)-*  -  (R^£LB)iR^Byh 
<l> 


and 


(R^iiB)(R^By^ 

2k, 


(3.68) 


k,  is  replaced  by  ,  which  gives 


'(R^^B){R^By^ 


Thus,  a  more  conservative  lower  bound  of  damping  is  obtained  as 


(R^^BXR^By^ 

2k^ 


Therefore,  a  time-varying  boundary  layer  thickness  is, 


kiR^&.B)iR^By^ 

2Cj^k^HR^^B)(R^Byh 


(3.69) 


(3.70) 


The  relationship  of  tuning  parameters  (C^  ,  k^  ,  z)  are  evaluated  in  Equation  (3.70).  The 

bandwidth  for  the  S  dynamics  is  given  by  Equation  (3.64),  in  which  the  spring  constant  is 

the  only  control  parameter  for  the  bandwidth.  Equation  (3.70)  provides  two  other  control 
parameters  (C^  ,  z)  which  give  more  capability  of  tuning  and  shaping  the  S  dynamics. 
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In  summary,  the  versatile  sliding  control  provides  a  second-order  low-pass  filter  (5 
dynamics)  and  a  high-pass  (or  band-pass)  filter  (error  dynamics).  Figure  9  illustrates  a  detailed 
synthesis  view  of  versatile  sliding  control  system.  The  S  dynamics  as  low-pass  filter  is  designed 
to  reject  the  high-frequency  uncertainties  (unmodeled  dynamics,  error  dynamics  and 
disturbances).  Low-frequency  uncertainties  are  then  filtered  by  high-pass  (or  band-pass)  filter. 
A  detailed  block  diagram  of  versatile  sliding  control  system  is  shown  in  Figure  10. 
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Figure  9  A  Detailed  Synthesis  View  of  Versatile  Sliding  Control 


Figure  10  A  Detailed  Block  Diagram  of  Versatile  Sliding  Control 


IV.  RESULTS 


To  perform  simulation  and  implementation,  the  structured  uncertainties  were  first  to  be 
determined.  The  nominal  values  of  the  system  parameters  and  their  bounds  were  estimated.  A 
non-robust  controller  was  designed  to  estimate  the  nominal  values  and  the  bounds  [Ref.  14].  The 
time  history  of  these  two  parameters  for  two  different  payload  (0  kg  and  0.85  kg)  illustrated  in 
Figure  11  (a)- 11(g).  Thus,  the  value  for  each  parameter  can  be  determined  and  p  ,  andy 

can  be  found  in  the  Table  2. 


Table  2 


Payload 

P 

A 

B 

Y 

/ 

0.00  kg 

295.00 

[0  0  11005. oof 

677177.18 

[0.9022  10.7036  -57732.00]^ 

0.85  kg 

218.95 

[0  0  5932.20f 

35684.40 

[0.8557  5.6229  -35097.00]^ 

For  conservative  reasons,  set  of  parameters  for  the  0.00  kg  case  was  selected  and  used 
in  the  simulation  and  implementation  throughout  the  whole  research.  The  computer  simulation 
of  the  control  system  was  performed  on  a  16  Mhz  80386  IBM  compatible  personal  computer 
with  MATLAB  programs.  The  MATLAB  simulation  programs  and  the  FORTRAN 
implementation  programs  are  listed  in  the  appendix  A  and  B. 

The  SMC  control  algorithms  used  for  simulation  and  implementation  on  the  single-link 
flexible  arm  are  the  sliding  control  with  first-order  sliding  condition,  The  straight  sliding  control, 
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and  the  versatile  sliding  control.  The  following  sections  will  evaluate  the  performances  of  these 
three  sliding  controllers.  To  show  the  robustness  to  the  uncertainties  due  to  varying  payload  and 
to  perform  the  tuning  procedure  such  that  the  unmodeled  high-frequency  will  be  rejected  are  the 
main  goal  of  this  research.  The  control  system  performance  will  be  evaluated  according  to  the 
tracking  accuracy,  the  response  speed,  and  the  overshoot. 

A.  RESULTS  ON  SLIDING  CONTROL  WITH  FIRST-ORDER  SLIDING  CONDITION 
PLUS  INTEGRAL  ERROR 

The  system  was  simulated  with  a  time  interval  of  0.001  (sec).  The  controlling  parameter^ 
for  sliding  speed  was  selected  to  be  10.  An  unit-step  response  of  continuous  sliding  control 
system  of  simulation  and  experiment  was  first  investigated.  Figures  12(a)-12(d)  show  the  system 
responses  (i.e.,  controlled  tip  position  (<p),  control  input,  S  response,  and  boundary  layer 
thickness  (<{)))  of  simulation  without  payload  where  =  10  (rad/sec).  The  poles  of  error 

dynamics  were  at  p=[-10  -10  -10].  The  tip  position  response  shows  large  overshoot.  Time- 
varying  boundary  layer  thickness  was  computed  to  achieve  the  continuous  sliding  control. 

It  was  observed  that  |sj  |  <  <j)  and  the  S  dynamics  was  governed  by  a  first-order  dynamics  where 
the  controlling  parameter  determines  the  response  speed.  The  large  overshoot  will  be 

minimized  by  fine  tuning  the  S  dynamics  such  that  the  system  response  speed  was  primarily 
determined  by  placing  the  poles  of  error  dynamics.  The  tightness  of  the  boundary  layer  can  also 
improve  system  response  speed. 

A  higher  bandwidth  was  selected,  i.e.,  X^  =  500  (rad/ sec)  to  reduce  the  boundary 
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layer  thickness  and  to  reduce  the  overshoot.  Figures  13(a)- 13(d)  present  the  performance  with 
no  steady-state  error  and  the  overshoot  was  improved.  It  should  be  noted  that  the  greater 
bandwidth  will  allow  high-frequency  unmodeled  dynamics  to  excite  S  dynamics.  It  was  observed 
that  with  a  greater  ,  the  response  speed  is  faster.  However,  the  level  of  control  input  is 

increa^.  With  the  tighter  boundary  layer,  the  level  of  overshoot  was  improved.  Because 
boundary  layer  thickness  becomes  thinner  and  the  sampling  rate  was  not  high  enough,  the 
occurrence  of  chattering  is  not  surprising  and  the  current  (i.e.,  control  input)  saturation  occurs. 
By  selecting  the  higher  sampling  rate  to  eliminate  chattering  and  saturation,  i.e.,  Ar  =  0.0005 
(sec).  Figures  14(a)- 14(d)  show  the  further  improvement  of  control  performance  in  the 
simulation  without  payload.  Figures  14(e)-14(h)  show  the  experimental  results.  Figures  15(a)- 
15(d)  show  the  responses  in  simulation  and  Figures  15(e)- 15(h)  show  those  in  experiment  with 
payload  (0.85  kg)  when  X^  =  500  (rad/sec)  and  simulation  time  interval  Af  =  0.0005  (sec). 

The  next  test  was  to  examine  the  tracking  performance.  The  desired  trajectory  was 
defined  as 


t 

1 

3-f 

0.6 


for  0  s:  r  <  1 
for  1  s  r  <  2 
for  2  s  f  <  2.4 
for  t  >  2.4 


(4.1) 


Figures  16(a)-16(h)  show  the  tracking  performance  of  the  system  in  simulation  and  experiment 


without  payload  and  Figures  17(a)- 17(h)  show  the  tracking  performance  with  payload  (0.85  kg). 


A  greater  bandwidth  (A.^^  =  1700  rad/sec)  was  selected  to  tight  the  boundary  layer. 


With  the  trajectory  control,  the  overshoot  can  be  further  minimized.  The  improvement 
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on  reducing  the  overshoots  is  very  important  for  robot  applications.  The  overshoot  in  the 
experimental  results  reflected  the  simulation  prediction.  The  time  history  of  the  boundary  layer 
thickness  in  the  simulation  differs  from  that  in  the  experiment.  This  difference  can  be  neglected 
since  the  change  of  the  boundary  layer  thickness  compared  to  its  magnitude  was  quite  small.  The 
controller  is  robust  to  varying  payload  because  the  system  responses  were  not  affected  by 
changing  the  payload. 

In  summary,  the  maximum  bandwidth  is  the  only  parameter  to  reject  the  unmodeled  high- 
frequency  dynamics  and  at  the  same  time  to  control  tracking  accuracy  in  this  control  algorithm. 
Therefore,  a  trade-off  exists  between  the  robustness  to  the  unmodeled  dynamics  and  the  tracking 
accuracy.  With  an  integral  control  in  error  dynamics,  the  steady-state  error  was  eliminated.  The 
controller  is  indeed  robust  to  the  uncertainties  due  to  varying  payload. 

B.  RESULTS  ON  STRAIGHT  SLIDING  CONTROL 

Step  response  will  first  be  studied  to  examine  the  performance  of  the  straight  sliding 
control.  An  equivalent  spring  constant  and  a  damping  ratio  were  selected  as  =  10  (rad/sec) 

and  C4  =  1  simulated  at  Ar  =  0.0002  (sec),  while  the  poles  of  error  dynamics  were  selected 

as  p=[-10  -10].  Figures  18(a)-18(d)  show  results  of  a  step  response,  the  control  input,  and  the 
S  and  <{)  of  the  simulation  without  payload.  The  control  presents  not  only  overshoot  but  also 

long  settling  time.  Thus,  damping  ratio  (C^)  will  be  used  to  fine  tune  S  dynamics  such  that  the 
overshoot  will  be  minimized  and  the  settling  time  will  be  improved.  The  equivalent  spring 
constant  will  be  lowered  to  reject  high-frequency  excitation  of  the  S  dynamics. 
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The  effects  due  to  the  damping  ratio  will  be  examined.  The  damping  ratio  =  10 
was  selected  to  reduce  the  boundary  layer  thickness  while  =  10  (rad/sec).  Figures  19(a)- 
19(d)  show  the  performance  of  step  response,  the  control  input,  and  the  S  and  ^  of  the 
simulation  without  payload.  Figures  19(e)- 19(h)  show  the  step  response  of  experiment  at  = 

10  and  0)^  =  10  (rad/sec).  The  overshoot  was  minimized  and  the  response  speed  was  faster  than 
before. 

The  next  test  is  to  lower  the  i.e.,  lowering  the  bandwidth  of  the  S  dynamics  to 

reject  the  high-frequency  excitations,  =  1  (rad/sec)  and  =  10  were  selected.  Figures 

20(a)-20(d)  present  the  control  performance  (without  payload)  where  the  step  response  has 
steady-state  error.  To  reject  the  unwanted  high-frequency  excitations,  the  control  system  has  to 
pay  the  price.  However,  the  damping  ratio  can  be  increased  to  remedy  the  sluggish  of  the 

response.  Figures  2  l(a)-2 1(h)  show  the  control  performance  of  *•>,  =  1  (rad/ sec)  and  =  100 

for  both  simulation  and  experiment  without  payload.  Figures  22(a)-22(h)  present  the  control 
performance  of  =  1  (rad/sec)  and  =  100  for  both  simulation  and  experiment  with 

payload  (0.85  kg).  It  is  noted  that  the  control  performance  showed  no  difference  in  changing  the 
payload. 

The  last  investigation  was  to  examine  robustness  to  varying  payload  of  the  tracking 
performance.  The  desired  trajectory  was  designed  as  in  Equation  (4. 1).  Figures  23(a)-23(d)  show 
the  tracking  performance  for  the  simulation  at  =  1  (rad/sec)  and  C^,  =  100  without  payload. 
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Figures  23(e)-23(h)  show  the  tracking  performance  for  the  experiment  at  g)^  =  1  (rad/sec)  and  Ci 

=  100  without  payload.  Figures  24(a)-24(h)  illustrate  the  tracking  performance  for  the 
simulation  and  experiment  at  =  1  (rad/ sec)  and  =  100  with  payload  (0.85  kg).  Theo^ 

=  1  (rad/sec)  was  selected  not  to  excite  the  unmodeled  high-frequency  dynamics. 

Note  that  the  control  performance  was  not  affected  by  the  payload.  The  greater  the 
damping  ratio  C^.,  the  better  the  tracking  performance  and  the  greater  the  control  effort  is 

needed.  Although  the  smoothed  control  law  was  used  to  compute  the  current  required  to  the 
actuator,  a  little  chattering  occurred  in  the  experimental  results  while  the  arm  was  trying  to  stand 
still. 

In  summary,  the  straight  sliding  control  utilizes  the  first-order  plus  integral  sliding 
condition  to  provide  tracking  accuracy,  disturbance  rejection,  and  stability.  The  S  dynamics 
plays  a  key  role  to  obtain  a  desired  system  response  since  the  error  dynamics  is  affected  by  the 
output  of  S  dynamics.  The  two  control  parameters  and  are  adjusted  to  accomplish  the 

control  task  without  conflicting.  The  damping  ratio  C^,  was  selected  to  tight  the  S  dynamics 

performances,  while  the  in  the  sliding  condition  to  keep  the  excitation  from  entering  into 

the  S  dynamics.  Therefore,  the  trade-off  between  tracking  accuracy  and  robustness  to 
uncertainties  (due  to  unmodeled  high-frequency  dynamics)  has  no  longer  exist.  Also,  the 
robustness  to  the  varying  payload  was  proved  by  the  simulation  and  the  experiment. 
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C.  RESULTS  ON  VERSATILE  SLIDING  CONTROL 

The  step  response  of  versatile  sliding  control  was  to  test  the  control  performances.  To 

keep  the  bandwidth  of  S  dynamics  low,  the  was  selected  to  be  1.  The  zero  (z)  not  only 

provides  the  filtering  level  of  error  dynamics  but  also  affects  the  boundary  layer  thickness.  Thus, 
the  z  should  be  chosen  carefully  such  that  the  S  dynamics  can  be  fine  tuned.  For  a  given  value 

of  Cl,  the  smaller  z,  the  larger  boundary  layer  thickness.  Also,  greater  boundary  layer 

thickness  gives  more  active  S  dynamics.  Given  z  =  1  and  Cx,  =  Figures  25(a)-25(d)  show 

the  step  responses,  the  control  input,  and  the  5  and  4>  of  simulation,  while  the  poles  of  error 

dynamics  were  p=[-10  -10  -10].  Figures  25(e)-25(h)  show  the  experiment  results.  The  overshoot 
exhibited  in  the  control  motion.  With  the  same  C^i  Figures  26(a)-26(d)  present  the  responses 

of  a  greater  value  z  =  10  without  payload.  The  overshoot  was  reduced  by  reducing  the 
boundary  layer  thickness.  However,  the  steady-state  error  occurred.  Figures  26(e)-26(h)  present 
the  results  for  the  experiment  without  payload  at  z  =10  and  Ci  =  10.  Figures  27(a)-27(h) 

present  the  simulation  and  the  experiment  with  payload  (0.85  kg)  at  z  =10  and  =  10. 

The  next  test  was  to  examine  tracking  performance.  The  trajectory  was  designed  as  in 
Equation  (4.1).  Given  z  =  10,  Ci  =  10,  and  =  1  (rad/sec).  Figures  28(a)-28(h)  show  the 

performances  of  simulation  and  experiment. 

The  overall  tendency  of  the  control  system  in  the  experiment  has  the  same  results  as 
expected  in  the  simulation.  The  smaller  the  boundary  layer,  the  smaller  the  steady-state  error. 
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and  the  greater  control  input  is  needed.  The  little  chattering  occurred  in  the  straight  sliding 
control  was  seen  in  the  performance  of  versatile  sliding  control.  It  is  noted  that  the  robust  to  the 
varying  payload  is  achieved  by  increasing  the  payload  while  the  motion  control  will  not  be 
changed. 

In  summary,  the  versatile  sliding  control  provides  three  parameters  to  accomplish  the 
control  motion.  The  damping  ratio  and  z  were  chosen  to  tight  the  boundary  layer  thickness 

and  also  the  was  set  low  to  reject  the  excitations  entering  the  error  dynamics.  The  z  not 

only  gives  the  tuning  on  the  boundary  layer  thickness  but  also  make  the  error  dynamics  a  band¬ 
pass  (or  high-pass)  filter.  Actually,  the  versatile  sliding  control  provides  more  tuning  parameters 
which  make  the  trade-off  between  tracking  accuracy  and  robustness  to  uncertainties  (unmodeled 
high-frequency  dynamics)  no  longer  exist.  Also,  the  versatile  sliding  controller  is  proved  to  be 
robust  to  the  uncertainties  due  to  varying  payload. 
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Figure  ll(a)-(d)  The  Time  History  of  System  Parameters 
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Figure  1 1(e)'(h)  The  Time  Hislory  of  System  Parameters 
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Figure  12(a)-(cl)  The  Simuiation  Performance  of  SMC  with  First-Order  Sliding  Condition 
=  lU  rad/scc,  Ar  =  0.001  (sec),  payload  =  0.00  kg) 
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Figure  13(a)-(d)  The  Simulation  Performance  of  SMC  with  First-Order  Sliding  Condition 
=500  rad/sec,  =  0.001  (sec),  payload  =  0.00  kg) 
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Figure  15(a)-(d)  The  Simulation  Performance  of  SMC  with  First-Order  Sliding  Condition 
(^Biu  ~  rad/sec,  Ar  =  0.0005  sec,  payload  =  0.85  kg) 
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Figure  16(e)-(h)  The  Experiment  of  tracking  Performance  of  SMC  with  First-Order  Sliding 
Condition  (X  =  500  rad/sec,  payload  =  0.00  kg) 
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Figure  17(c)-(li)  Tlie  Cxpcrinicnl  of  tracking  Performance  of  SMC  with  First-Order  Sliding 
Condition  =  1700  rad/scc,  payload  =  0.00  kg) 
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Figure  18(a)-(d)  The  Simulation  Performance  of  Straight  Sliding  Control 
(u)^  =  10  rad/sec,  =  1,  Ar  =  0.0002  (sec),  payload  =  0.00  kg) 
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Figure  19(a)-(cl)  The  Simulation  Performance  of  Straight  Sliding  Control 
=  10  rad/sec,  =  10,  Af  =  0.0002  (sec),  payload  =  0.00  kg) 
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Figure  19(e)-(h)  The  Experiment  Performance  of  Straight  Sliding  Control 
(<j^  =  10  rad/sec,  =  10,  payload  =  0.00  kg) 
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Figure  21(a)-(d)  The  Simulation  Performance  of  Straight  Sliding  Control 
(o)^  =  1  rad/sec,  =  100,  Ar  =  0.0002  (sec),  payload  =  0.00  kg) 
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Figure  22(a)-(d)  The  Simulation  Performance  of  Straight  Sliding  Control 
=  1  rad/sec,  =  100,  Ar  =  0.0002  (sec),  payload  =  0.85  kg) 
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Figure  24(a)-(d)  The  Tracking  Performance  in  Simulation  of  Straight  Sliding  Control 
(o)^  =  1  rad/scc,  =  100,  Ar  =  0.0002  (sec),  payload  =  0.85  kg) 
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Figure  26(a)  _  _ Figure  26(b) 


Figure  26(a)-(ci)  The  Simulation  Performance  of  Versatile  Sliding  Control 
(w„  =  I  rad/sec,  z  =  10,  =  10,  Ar  =  0.0002  (sec),  payload  =  0.00  kg) 
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Figure  27(a)-(d)  The  Simulation  Performance  of  Versatile  Sliding  Control 
(o)„  =  1  rad/sec,  z  =  10,  =  10,  A/  =  0.0002  (sec),  payload  =  0.85  kg) 
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V.  CONCLUSIONS  AND  RECOMMENDATIONS 


A.  CONCLUSIONS 

The  purpose  of  doing  this  research  was  motivated  by  the  need  of  using  a  flexible 
manipulator  in  the  modem  robotic  application  and  of  designing  a  simple  robust  control  (sliding 
mode  control)  algorithm  enabling  a  single-link  flexible  manipulator  to  perform  accurate  tracking 
under  the  environmental  disturbances  and  uncertainties  due  to  varying  payload. 

Because  of  the  simple  control  structure  of  sliding  mode  control,  the  robust  control  system 
was  implemented  on  a  low-cost  IBM- AT  micro-computer  for  the  flexible  arm  system.  Unlike 
the  high-speed  switched  sliding  control,  the  predictor-corrector  continuous  control  law  was 
achieved  by  introducing  a  time-varying  boundary  layer.  Three  different  forms  of  Lyapunov 
stability  criterion  (or  sliding  condition)  were  utilized  not  only  to  guarantee  the  stability  of  the 
control  system  but  to  provide  different  tuning  capability. 

In  the  sliding  control  with  first-order  sliding  condition,  the  only  control  parameter 

not  only  provides  the  tightness  of  the  boundary  layer  but  also  gives  bandwidth  of  the  S 
dynamics.  The  tighter  the  boundary  layer,  the  faster  the  response  speed  and  the  smaller  the 
steady-state  error.  However,  the  trade-off  between  tracking  accuracy  and  the  robustness  to  the 
unmodeled  high-frequency  dynamics  exists.  The  integral  error  control  will  drive  the  steady-state 
error  to  zero. 

The  straight  sliding  control  with  first-order  plus  integral  sliding  condition  provides  control 
tuning  parameters  ( and  C^,)  such  that  the  rejection  of  uncertainties  and  tracking  accuracy  can 
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be  achieved  at  the  same  time.  The  integral  of  S  provides  an  ability  to  have  the  steady-state 
values  of  S  zero  for  constant  input  to  the  S  dynamics,  and  the  steady-state  error  of  the  system 
will  be  driven  to  zero.  The  equivalent  spring  constant  (o,^)  provides  an  rejection  to  the 

unmodeled  high-frequency  dynamics.  The  lower  bound  of  damping  ratio  (C^)  provides  a  fine 

tune  on  the  thickness  of  boundary  layer.  The  thinner  the  boundary  layer  thickness,  the  faster  the 
response  speed  and  the  smaller  the  steady-state  error.  However,  from  the  experiment,  even  with 
continuous  control,  the  small  chattering  occurred  while  the  arm  wanted  to  stand  still.  This 
phenomenon  has  not  been  clear. 

The  versatile  sliding  control  algorithm  provides  a  second-order  sliding  condition.  The 
bandwidth  of  S  dynamics  was  selected  to  be  low  so  that  the  high-frequency  unmodeled 
uncertainties  will  be  rejected  and  the  error  dynamics  will  not  be  excited.  The  lower  bound  of 
damping  and  z  in  the  5  dynamics  can  then  be  fine  tuning  to  tight  the  boundary  layer  so  that  the 
tracking  accuracy  can  then  be  achieved.  Therefore,  the  trade-off  between  the  tracking  accuracy 
and  the  robustness  to  the  uncertainties  has  no  longer  existed.  However,  the  same  chattering  in 
control  input  as  in  the  straight  sliding  control  occurred  when  the  control  was  implemented. 

In  summary,  despite  the  use  of  simplified  model,  the  simple  structure  sliding  control  is 
indeed  robustness  to  uncertainties  due  to  varying  payload.  Also,  by  providing  more  tuning 
capability,  the  trade-off  between  tracking  accuracy  and  the  robust  to  the  high-frequency 
dynamics  was  released. 
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B.  RECOMMENDATIONS 

The  further  works  are  recommended  as  follows  : 

(1)  To  develop  a  systematic  procedure  to  tune  controlling  parameters. 

(2)  To  clarify  the  small  chattering  occurred  in  the  implementation  while  using  straight 
and  versatile  sliding  control. 

(3)  To  develop  the  multiple-link  control  system  using  ERLS. 
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APPENDIX  A 


MATLAB  SIMULATION  PROGRAM 


DEFINATIONS  OF  THE  PARAMETERS  : 

*  lambda  =  the  max.  bandwidth  h  =  time  interval 

*  w  =  tunning  parmeter  to  tunne  the  max.  bandwidth 

*  zeta  =  tunning  parameter  to  provide  more  tunning  capability 


=  final  time  ml  =  payload 

=  pole-placement  of  poles  speed  =  sliding  speed 

=  B  hat(uncrtainties)  DB  =  DELTA  B 

=  fhat(uncertainties)  Df  =  DELTA  f 

=  length  of  the  arm  rho  =  density  of  arm 

=  cross  asection  area  of  arm  E  =  modulusof  elasticity 

=  Area  moment  of  inertia  of  flexible  arm 
=  deformation  matrix  differentiation  w.r.t.  deflection 


* 

g 

« 

K 

4c 

Dm 

4c 

Vt 

4c 

Ps 

4c 

Ctm 

4c 

eff 

4i 

betae 

4c 

Ip 

4c 

Ir 

4c 

betal 

4c 

beta2 

4c 

Cl 

4c 

C2 

4c 

nlm 

4c 

nlnlm 

4c 

Ixnlm 

4c 

swwsm 

4c 

klei 

4« 

maa 

4c 

mab 

4c 

mba 

4c 

mbb 

4c 

kb 

4i 

fa 

4c 

fb 

4c 

theta 

* 


=  gravitational  acceleration  vector 
=  servovalve  sizing  constant 
=  actuactor  displacement 

=  total  compress  volumeincluding  actuactor  lines  and  chambers 
=  hydraulic  supply  pressure 
=  total  leaking  coefficient 
=  torque  efficiency 
=  effective  bulk  modulus 
=  moment  of  inertia  of  payload 
=  moment  of  inertia  of 
=  mode  shape  coefficient 
=  mode  shapew  coefficient 
=  computed  mode  shape  coefficient 
=  computed  mode  shape  coefficient 
=  to  evaluate  the  coeffieient  and  be  used  in  fa 

=  to  evaluate  the  coeffieient  and  be  used  in  maa 

=  to  evaluate  the  coefficient  and  be  used  in  mab  or  mba 

=  to  evaluate  the  coefficient  and  be  used  in  maa 

=  to  evaluate  the  coefficient  and  be  used  in  kb 

=  coefficient  of  large  motion  acceleration  in  large  motion  dynamics 
=  coefficient  of  small  motion  acceleration  in  large  motion  dynamics 
=  coefficient  of  large  motion  acceleration  in  small  motion  dynamics 
=  coefficient  of  smalle  motion  acceleration  in  small  motion  dynamics 
=  coefficient  of  stiffness  in  small  motion  dynamics 
=  right-hand-side  of  large  motion  dynamics 
=  right-hand-side  of  small  motion  dynamics 
=  large  motion  angle  and  thetaold  represents  previous  one  in 
computation,  thetanew  represents  the  new  one. 
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thetad  =  velocity  of  large  motion  with  the  same  expression  as  theta 
thetadd  =  acceleration  of  large  motion  with  tha  same  expression  as  theta 

V  s:  small  motion  and  void  represents  previous  one  in  the  computation 

and  the  vnew  represents  the  new  one. 

vd  =  velocity  of  small  motion  and  has  the  same  expression  as  in  v. 

vdd  =  acceleration  of  small  motion  and  has  the  same  expression  as  in  v 

pi  -  load  hydraulic  pressure  drop 

Ps  =  hydraulic  supply  pressure 

current  =  the  current  input  the  electrohydraulic  actuactor 
psi  =  total  angle  is  the  sum  of  large  motion  (theta)  and  small  motion  (v) 

psiv  =  velocity  of  total  angle 

psia  =  acceleration  of  total  angle 

psir  =  desired  total  angle 

psivr  =  the  first  time  derivative  of  psir 

psiar  =  the  second  time  derivative  of  psir 

psijk  =  the  third  time  derivative  of  psir 

Function  expalnation 

constl  =  to  perform  the  computation  of  constant  in  the  program 
timinvarm  =  to  perform  the  computation  of  time  invariant  terms 

ic  =  to  perform  the  computation  of  initial  condition 

tracking  =  to  give  the  desired  trajectory 
sequenm  to  perform  the  sequential  integration  method 

tippva  =  to  perform  the  transformation  of  total  expression 

ismco  =  to  compute  the  current  using  sliding  control  with  first-order 

sliding  condition 

ismcst  =  to  compute  the  current  using  the  straight  sliding  control 

ismcva  =  to  compute  the  current  using  the  versatile  sliding  control 

hydralm  =  to  perform  the  dynamics  of  electrohydraulic  actuactor 

plotter  =  to  perform  the  plot 


%  sliding  control  with  first-order  sliding  condition  algorithm 
clear, clg 

tra=input(’Enter  desired  trajectory  1  or  2  ’) 
lambda=input(’please  enter  lamb^  ’) 

h=0.001;FT=10;t=0:h:FT; 

ml =0;speed  =  10;R =[300;30;  1];G =[1000;0;0]; 

Bhat=[0;0;l.le4];DB=295;fhat=[0;0;-5.7732e4];Df=6.7117e4; 

Ahat=[0  1  0;0  0  1;0  0  0];DA=0; 

[L,rho,A,E,I,Dv,g,K,Dm,Vt,Ps,Ctm,eff,betae,Ip,Ir,betal,beta2,Cl,C2,Bl,B2] 

=constl(ml); 
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%  computation  for  the  time  invariant  terms 

[nlm,nlnlm,lxnlm,swwsm,klei,mab,mba,mbb]=timinvarm(rho,A,E,I,betal,beta2 . 

,Cl,C2,Bl,B2,Dv,Ip,L,ml); 

%  Initial  Conditions 

[thetaold,thetadold,thetaddold,vold,vdold,vddold,torqueactold,pl,current(l). . . . 
,psi(l),psiv(l),psia(l)]=ic(Dm,eff,Ctm,Ps,K,L); 

%  desired  trajectory 
[psir,psivr,psiar,psijk]=tracking(t,tra); 

for  n = 1 :  (length(t)- 1 ) 

n  %  sequential  integration  method 

[thetanew,thetadnew,thetaddnew,vnew,vdnew,vddnew] =sequenm(thetaold,thetadold. . . 

,thetaddold,vold,vdold,vddold,mab,mba,mbb,swwsm,nlnlm,lxnlm,nlm,klei,Ip . 

,Ir,Dv,ml,g,h,L,A,rho,torqueactold); 

[psi(n+  l),psiv(n+  l),psia(n+ 1)] =tippva(thetanew,thetadnew,thetaddnew,vnew . 

,  vdnew ,  vddnew ,  L) ; 

%  sliding  mode  control  with  first-order  sliding  condition 

[current(n-l-  l),s(n+  l),intgerror,phi(n-t- 1)]  =ismco(Ahat,Bhat,fhat,DA,DB,Df,R,G. . , . 

,h,Iambda,psi(n-f-l),psiv(n-f-l),psia(n-f-l),psir(n-f-l),psivr(n+l),psiar(n  +  l) . 

,psijk(n-»‘  1), speed, intgerror); 

%  electriohydraulic  actu  actor 

[plnew,torqueactnew]=hydralm(h,current(n  +  l),thetadnew,pl,K,Dm,Vt,Ps,Ctm . 

,eff,betae); 
pi  =  plnew; 

% 

thetaold=thetanew;thetadold=thetadnew;thetaddold=thetaddnew; 
void =vnew;vdold =vdnew;vddold = vddnew; 
torqueactold = torqueactnew; 
end 

%  plotter  -  > 

[ps,pphi,pciirrent,ppsi]=plotter(s,phi,current,psi) 

4i  41 4c  41 «  4C  W  « l«i  Hr «  «  *  4<  *  4^ «  «  %  «  4i  *  W  «  4i  4c  *  *  4111c «  *  *  »  «  W  «  4i  *  « :«i 


%  Straight  Sliding  Mode  Control  Algorithm 
clear, clg 

tra=input(’Enter  desired  trajectory  1  or  2  ’) 
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w=input(’please  enter  w  ’) 
zeta=input(’please  enter  zeta  ’) 


h=0.0002;FT=1.2;t=0:h:FT;ml=0; 

R= [300;30;  1];G= [1000;0;0];speed = 10; 


%  Uncertainties 

Bhat=[0;0;  1.  le4];DB=295; 

fhat=[0;0;-5.7732e4];Df=6.7114e4; 

Ahat=[0  1  0;0  0  1;0  0  0];DA=0; 

%  Define  constants 

[L,rho,  A,E,I,Dv,g,K,Dm,  Vt,Ps,Ctm,eff,betae,Ip,Ir,betal  ,beta2,Cl  ,C2,B1  ,B2] . 

=constl(ml); 

%  computation  for  some  time  invariant  terms 

[nlm,nlnlm,lxnlm,swwsm,klei,mab,mba,mbb]=timinvarm(rho,A,E,I,betal,beta2 

,Cl,C2,Bl,B2,Dv,Ip,L,ml); 

%  Initial  conditions 

[thetaold,thetadold,thetaddold,vold,vdold,vddold,torqueactold,pl . 

,current(l),psi(l),psiv(l),psia(l)]=ic(Dm,eff,Ctm,Ps,K,L); 

%  desired  trajectory 
[psir,psivr,psiar,psijk]  =tracking(t,tra); 

%  Define  initial  values  used  in  straight  and  intgral  error  sliding  control 

[intgerr,intgs,s(l),phi(l)]=smciv(R,G,psi(l),psiv(l),psia(l),psir,psivr . 

,psiar,h,w,zeta); 

for  n = 1 :  (length(t)- 1) 
n 

[thetanew,thetadnew,thetaddnew,  vnew,vdnew,vddnew] = sequenmfthetaold . 

,thetadold,thetaddold,vold,vdold,vddold,mab,mba,mbb,swwsm,nlnlm,lxnlm,nlm. 

,klei,Ip,Ir,Dv,ml,g,h,L,A,rho,torqueactold); 

[psi(n+  l),psiv(n+ l),psia(n+ 1)]  =tippva(thetanew,thetadnew,thetaddnew . 

,vnew,vdnew,vddnew,L); 

%  straight  sliding  mode  control 

[current(n+ l),s(n+  l),intgs,intgerr,phi(n+  l)]=ismcst(Ahat,Bhat,fhat,DA,DB . 

,Df,R,G,h,w,psi(n+  l),psiv(n  +  l),psia(n+l),psir(n+  l),psivr(n+  l),psiar(n+ 1) . 

,psijk(n  + 1 ),  speed  ,intgs,  intgerr,  zeta) ; 
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%  electrohydraulic  actuactor 

(plnew,torqueactnew]=hydralm(h,cuiTent(n+l),thetadnew,pl,K,Dm,Vt,Ps,Ctm . 

,eff,betae); 

pl=plnew; 

% 

thetaold = thetanew;thetadold =thetadnew;thetaddold =thetaddnew; 
void = vnew;vdold =vdnew;vddold = vddnew; 
torqueactold = torqueactnew; 
end 

%  plotter  --  > 

[ps, pphi,pcurrent,ppsi]=plotter(s, phi, current, psi) 


%  Versatile  Sliding  Mode  Control  Algorithm 
clear, clg 

tra=input(’Enter  desired  trajectory  1  or  2  ’) 
w=input(’please  enter  w  ’) 
zo=input(’please  enter  z  ’) 
zeta=input(’please  enter  zeta  ’) 

h*  =0.0002;FT=  1.2t=0:h:FT;ml=0; 
speed  =  10;R = [300;30;  1];G = [1000;0;0]; 

%  Uncertainties 

Bhat=[0;0;l.le4];DB=295; 

fhat=[0;0;-5.7732e4];Df=6.7117e4; 

Ahat=[0  1  0;0  0  1;0  0  0];DA=0; 
s=0;intgerr=0; 

%  Defme  constants 

[L,rho,A,E,I,Dv,g,K,Dm,Vt,Ps,Ctm,eff,betae,Ip,Ir,betal,beta2,Cl,C2,Bl,B2] . 

= const  1  (ml); 

%  computation  for  some  time  invariant  terms 

[nlm,nlnlm,lxnlm,swwsm,klei,mab,mba,mbb]=timinvarm(rho,A,E,I,betal,beta2 

,Cl,C2,Bl,B2,Dv,Ip,L,ml); 

%  Initial  conditions 

[thetaold,thetadold,thetaddold,vold,vdold,vddold,torqueactold,pl,current(l) . 

,psi(l),psiv(l),psia(l)]=ic(Dm,eff,Ctm,Ps,K,L); 


%  Desired  trajectory 
[psir,psivr,psiar,psijk]=tracking(t,tra); 
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for  n=l;(length(t)-l) 
n  %  sequential  integration  method 

[thetanew,thetadnew,thetaddnew,vnew,vdnew,vddnew]=sequenm(thetaold . 

,thetadold,thetaddold,vold,vdold,vddold,mab,mba,mbb,swwsm,nlnlm,lxnlm . 

,nlm,klei,Ip,Ir,Dv,ml,g,h,L,A,rho,torqueactold); 

[psi(n+  l),psiv(n+  l),psia(n+ 1)]  =tippva(thetanew,thetadnew,thetaddnew . 

,vnew,vdnew,vddnew,L); 

%  Versatile  sliding  mode  control 

[current(n+  l),sdot(n),s,intgerr,phi(n)]  =ismcva(Ahat,Bhat,fhat,DA,DB,Df,R,G. . . . 

,psi(n+  l),psiv(n+  l),psia(n+ l),psir(n+ l),psivr(n+  l),psiar(n+ l),psijk(n+ 1) . 

, speed, s,intgerr,h,w,zo,zeta); 

%  electrohydraulic  actuator 

[plnew,torqueactnew] =hydralm(h,current(n+ l),thetadnew,pl,K,Dm,Vt,Ps . 

,Ctm,eff,betae); 

pl=plnew; 

% 

thetaold =thetanew;thetadold =thetadnew;thetaddold =thetaddnew; 
void = vnew;vdold = vdnew;vddold = vddnew; 
torqueactold = torqueactnew; 
end 

%  plotter  -  > 

[psdot,pphi,pcurrent,ppsi]  =plotter(sdot, phi, current, psi) 

4i  4i  4i  4141 4>  41 41 41*41 41 4i4i4>***4>4i******4i*«4>*«*4>***4i4i*«***4^ 


function  [L,rho,A,E,I,Dv,g,K,Dm,Vt,Ps,Ctm,eff,betae,Ip,Ir,betal,beta2,Cl 
,C2,B1,B2]  =  constl(ml) 


rho  =  7861.05;A  =  6.17795e-04; 

L  =  0.9985;g  =  [0;0;-9.8066]; 

E  =  2.0ell;I  =  4.065e-10; 

Dv=  [0  0  0;0  0  0;1  0  0];  %  first  derivative  of  D  w.r.t.  v 

lyy  =  (1.3653333e-3)*ml; 

Ixx=  ((ml/0.4233)"2)*(7.5e-06)*ml; 

Ip  =  [ml  0  0;0  Ixx  0;0  0  lyy];  %  Ip  =  moment  of  inertia  of  payload 
mr  =  9.0001 145 l;Ir  =  [mr  0  0;0  0.02746713  0;0  0  0.02746713]; 

K  =  2.402963e-09;  %  unit  =  (  m*4/(sec-mA-sqrt(N)) ) 

Dm  =  6.2271e-05;  %  unit  =  (  m*3/rad  ) 

Vt  =  3.05127e-04;  %  unit  =  (  m"3  ) 

Ps  ^  1.37888e07;  %  unit  =  (  N/m*2  ) 

Ctm  =  3.7064772e-13;  %  unit  =  (  m*5/N-sec  ) 
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betae  =  6.90e08;  %  unit  =  (  N/m"2  ) 

eff  =  0.9; 

betalL  =  1.875 104069;beta2L  =  4.694091133; 
betal  =  betalL/L;beta2  =  beta2L/L; 

Cll  =  sin(betalL)  +  sinh(betalL); 

C12  =  cos(betalL)  +  cosh(betalL); 

Cl  =  C11/C12; 

C21  =  sin(beta2L)  +  sinh(beta2L); 

C22  =  cos(beta2L)  +  cosh(beta2L); 

C2  =  C21/C22; 

D  =  4*Cl*beta2  -  4*C2*betal; 

B1  =  2*beta2/D;B2  =  -2*betal/D; 

«  4k  «  «  41 4t  41 4(  4k  4k  «  « IK  ^  4r  4c 


function  [alfa, delta, gama0,gamal,gama2,gama3,gaina4,gania5]  =  const2(h) 

alfa  =  0.25;delta  =  0.5; 

gamaO  =  l/(alfa*h*2); 
gamal  =  delta/(alfa*h); 
gama2  =  l/(alfa*h); 
gama3  =  (l/(2*alfa))-l; 
gama4  =  (delta/alfa)-l; 
gama5  =  ^/2)*((deIta/aIfa)-2); 


function  [alfa, delta, gamaO, gamal ,gama2,gama3,gama4,gama5,gama6,gama7]  =consG(h) 

alfa  =  0.25;delta  =  0.5; 

gamaO  =  l/(alfa*h'‘2); 
gamal  =  delta/(alfa*h); 
gama2  =  l/(alfa*h); 
gama3  =  (l/(2*alfa))-l; 
gama4  =  (delta/alfa)-l; 
gama5  =  (h/2)*((delta/alfa)-2); 
gama6  =  h*(l-delta); 
gama7  =  delta’ll!; 


function  [nlm,nlnlm,lxnlm,swwsm,klei,mmab,mmba,mmbb]=timinvarm(rho,A,E,I 
, betal  ,beta2,Cl  ,C2,B1  ,B2,Dv,Ip,L,ml) 

swwsm  =  simps(’swws’,0,0,0,0,0,0)*rho*A; 
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nlm  =  simps(’nr,betal,beta2,Cl,C2,Bl.B2)*rho*A; 
klei  =  simps(’kir,betal,beta2,Cl,C2,Bl,B2)*'E*I; 
nlnlm  =  simps(’nlnr,betal,beta2,Cl,C2,Bl.B2)*rho*A; 
Ixnlm  =  simps(’lxnr,^tal,^ta2,Cl,C2,Bl.B2)*rho*A; 
[D,Dd,w,wd,wdd,Ad,Add]  =  usualm(-pi/3,0,7,L); 
mmba  =  mba(D,w,wd,Dv, Ip, Ixnlm); 
mmbb  =  mbb(w,Dv,Ip,nlnlm,ml); 
mmab  =  mab(D,w,wd,Dv,Ip,lxnlm,ml,L); 


function  [thetal  ,thetadl ,thetaddl  ,vl  ,vdl  ,vddl ,torqueactl ,pl,currentl  ,psil 
,psivl,psial]=ic(Dm,eff,Ctm,Ps,K,L) 

thetal  =0;thetadl  =0;thetaddl  =0; 

vl=-0.03111;%vl=-0.06111;%vl=-0.146064149;%vl=-0.23155; 

vdl=0;vddl=0; 


torqueactl  =  44.5549095;pl=torqueactl/(Dm*eff); 
Q = elm’ll;!© = Q/(K*sqrt(Ps-pl))  ;Imax = 10; 
ifrac=0.5*(Imax-I0);currentl=I0+ifrac; 


%  Trajectory  design  function 
% 

function  [psid,psivd,psiad,psijerk] =tracking(t,n) 


if  (n  =  =  l) 

psid  =ones(t);psivd =zeros(t);psiad =zeros(t);psijerk=zeros(t); 
elseif(n==2) 

psijerk=0;psiad =0; 
for  n  =  l;length(t) 
if  (t(n)<l) 

psid(n) =t(n);psivd(n)  =  1 ; 
elseif  (1  <  =t(n)  &  t(n)<2) 
psid(n)  ==  1  ;psivd(n)  =0; 
end 

if  (2<  =t(n)  &  t(n)<2.4) 
psid(n) = 3-t(n)  ;psivd(n) = - 1 ; 
elseif  (t(n)>  =2.4) 

psid(n)=0.6;psivd(n)=0; 

end 

end 

end 
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% 

%  Sequential  integration  method  is  used  to  do  numerical  iteration. 

% 

function  [thetanew,thetadnew,thetaddnew,vnew,vdnew,vddnew]  =  sequen(theta . 

,thetad,thetadd,v,vd,vdd,mab,mba,mbb,swwsm,nlnlm,lxnlm,nlm,klei,Ip,Ir,Dv . 

,ml,g,h,L,A,rho,torque) 

[alfa, delta, gama0,gamal,gama2,gama3,gama4,gama5]  =  const2(h); 

%  following  steps  are  solving  for  small-motion(vnew,  vdnew,  &  vddnew) 

%  (1)  original  coefficients  computation  ( large  and  small-motion  )  at  time  t 
[D,Dd,w,wd,wdd,Ad,Add]  =  usualm(theta,v,vd,L); 

Kb  =  kb(thetad,klei,nlnlm); 

Fb  =  fb(thetad,w,wd,D,Dd,nlm,Dv,Ip,g,ml); 

Maa  =  maa(v,wd,Ad,D,Ip,Ir,swwsm,nlnlm,A,rho); 

Fa  =  fa(v,vd,thetad,wd,wdd,Ad,Add,D,Dd,Ip,Ir,nlm,nlnlm,g,ml,torque); 

%  (2)  modify  small-motion  coefficients  (  at  time  t )  to  avoid  secular  terms 
Mbs  =  mbb  -  mba*(l/Maa)*mab; 

Fbs  =  Fb  -  mba*(l/Maa)’^Fa; 
omega  =  (l/(2'*^i))*sqrt(Kb/Mbs); 

C  =  0.2*(sqrt(Kb/Mbs)); 

%  (3)  fast  (small)  motion  solver  ->  vnew,  vdnew,  and  vddnew 
Kbi  =  Kb  4-  gamaO’^(Mbs)  +  gamal*C; 

Fbi =Fbs  -I-  Mbs*(gamaO’^v + gama2  ^vd + gama3  *vdd)  -f  C'^(gama  1  *v  -f  gama4*vd  -I-  gama5  *vdd) ; 
vnew  =  (inv(Kbi))*Fbi; 

vdnew = vd  4-  ( 1  -delta)  *h*vdd  -I-  gama  1  ’^(vnew-v)-((delta/alfa)  *vd)-gama3  *delta*h*vdd ; 
vddnew  =  gamaO’*‘(vnew-v)  -  gama2*vd  -  gama3*vdd; 

%  using  predictor  and  corrector  scheme  to  find  large-motion 
%  (1)  using  predictor  and  new  etas’  to  evaluate  large-motion  coefficients 
thetap  =  theta  +  thetad*h  +  (0.5-alf?.)*(h*h)*(thetadd); 
thetadp  =  thetad  +  (1 -delta) ’^h'^theiadd; 

[D,Dd,w,wd,wdd,Ad,Add]  =  usualm(thetap,vnew,vdnew,L); 

Maa  =  maa(vnew,wd,Ad,D,I|^,Ir,swwsm,nlnlm,A,rho); 

Fa  =  fa(vnew, vdnew, thetadp, wd, wdd,  Ad,  Add, D,Dd, Ip, Ir,nlm,nlnlm,g,  ml, torque); 

%  (2)  solve  for  thetaddnew 
Fae  =  Fa  -  mab*vddnew; 
thetaddnew  =  Fae/(Maa); 

%  (3)  find  correctors  using  thetaddnew 
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thetac  =  alfa*(h*h)*thetaddnew; 
thetadc  =  delta*h*thetaddnew; 

%  (4)  solve  for  thetanew  and  thetadnew 
thetadnew  =  thetadp  +  thetadc; 
thetanew  =  thetap  +  thetac; 


function  [x,xr,xrd] =tippva(theta,thetad,thetadd,v,vd,vdd,psid,psivd,psiad . 

,psij,L) 

psi  =  theta  +  (v/L); 
psiv  =  thetad  +  (vd/L); 
psia  =  thetadd  +  (vdd/L); 
x=[psi;psiv;psia]; 

XT  -  [psid;psivd;psiad] ; 
xrd  =  [psivd;psiad;psij]; 


function  [current, s.intgerror, phi] =ismco(Ahat,Bhat,fhat, DA, DB,Df,R,G,h, lambda, 
,psi,psiv,psia,psir,psivr,psiar,psijk,speed,intgerror); 

X = [psi;psiv;psia]  ;xr = [psir;psivr;psiar]  ;xrd = [psivr;psiar;psijk] ; 

error  =  x  -  xr; 

intgerror = intgerror + error*h ; 

RtB = inv(R’  *Bhat)  ;RtBn = nonn(RtB,2) ; 
s =R’  *error+ G’  ♦intgerror; 

RtBsgn = RtB*sign(s)  ;RtBsn = norm(RtBsgn  ,2) ; 

%  norminal  value 

Ihat  =  R’*(xrd-fhat-Ahat*x)-G’ ♦error; 

Ihatn=  norm(Ihat,2); 

boxl  =RtB^Ihat; 
box  1  n = norm(box  1 , 2) ; 

%  k 

Rn=norm(R,2); 

k = ((Rn)  ♦(Df  +  DB*box  1  n) + speed)/(  1  -(DB*RtBsn)) ; 
phi =(k/lambda)^(l +DB^RtBn); 


std= s/phi; 
if(  abs(s)  >  =phi  ) 
if(  std  >  =0  ) 
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sat=l; 

else 

sat=-l; 

end 

elseif(  abs(s)<phi ) 
sat=std; 
end 

current = (RtB)  *(Ihat-k*sat) ; 
if(  current  >  =  10) 
current=10; 
end 

if(  current  <  =  10) 
current =-10; 
end 

m  %  41 m  1)1 4i  #  *  *  *  IX  *  «  %  #  ^  4<  <1 41  %  «  *  *  4c  *  1*1  :ti  ^  1*1  *  *  4c  *  1)1  ^  ^  ^  ^  It> 


function  [current, s,intgs,intgerr, phi] =ismcst(Ahat,Bhat,fhat, DA, DB,Df,R,G 
,h,w,psi,psiv,psia,psir,psivr,psiar,psijk,speed,intgs,intgeiT,zeta); 

X  =  [psi;psiv;psia]  ;xr = [psir;psivr;psiar]  ;xrd = [psivr;psiar;psijk] ; 

error = x-xr ;  s = R  ’  ’"error; 

intgs=intgs+s*h; 

RtB = inv(R’  *Bhat)  ;RtBn = norm(RtB,2) ; 

RtBsgn = RtB’^signCs) ;  RtBsn = normfRtBsgn  ,2) ; 

%  norminal  value 

Ihat=R”"(xrd-fhat-Ahat’"x)-(w*2)’"intgs; 

Ihatn = norm(Ihat,2) ; 

boxl=RtB’"Ihat; 
box  1  n = norm  (box  1 , 2) ; 

%  k 

Rn=nonn(R,2); 

k = ((Rn)’"(Df  -f-DB’"box  1  n) + speed)/(  1  -(DB ’"RtBsn)); 

%  tuning  parameters 

lambda =(sqrt(l  -f-DB’"RtBn))’"w; 

phi = (k/(2'"zeta’"lambda))’"(DB’"RtBn) ; 


std  =  s/phi; 
if(  abs(s)>  =phi  ) 
if(  std>  =0  ) 
sat=l; 
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else 

sat=-l; 

end 

elseif(  abs(s)<phi ) 
sat=std; 
end 

%  (3)  current 
current = RtB*(Ihat-k*sat) ; 
if(  current  >  =  10) 
current =10; 
end 

if(  current  <  =-10) 
curTent=-10; 
end 


function  [current, sdot,s,intgerr, phi]  =ismcva(Ahat,Bhat,fhat, DA, DB,Df,R,G 
,psi,psiv,psia,psir,psivr,psiar,psijk,speed,s,intgerr,h,w,zo,zeta); 

X = [psi;psiv;psia]  ;xr = [psir;psivr;psiar]  ;xrd = [psivr;psiar;psijk] ; 
error=x-xr; 

intgerr = intgerr + error*h ; 

sdot =R’  *error + G’  *intgerT-zo*s; 

s=s+sdot*h; 

RtB = in  v(R  ’  *Bhat) ;  RtBn = norm(RtB ,  2) ; 

RtBsgn  =RtB*sign(sdot);RtBsn =nonn(RtBsgn,2); 

%  norminal  value 

Ihat = R’  *(xrd-fhat- Ahat'^x)-(w‘^2)  *s-G’  *error + zo*sdot; 

Diatn =norm(Ihat,2); 

boxl  =RtB*Ihat; 
boxln=norm(boxl  ,2); 

%  k 

Rn=nomi(R,2); 

k=((Rn)*(Df-l-DB*boxln)-l-speed)/(l-(DB*RtBsn)); 

%  tuning  parameters 

lambda =(sqrt(l  -f-DB*RtBn))’*‘w; 

phi = (k*(DB*RtBn))/((2*zeta’^lambda) + (DB*RtB*zo)); 

%  sat(sdot)  FUNCTION 
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std=sdot/phi; 
if(  abs(sdot)  >  =phi ) 
if(  std>  =0 ) 
sat=l; 
else 

sat=-l; 

end 

elseif(  abs(sdot)<phi ) 
sat=std; 
end 

%  CURRENT 
current=RtB*(Ihat-k*sat); 
if(  current  >  =  10) 
current =10; 
end 

if(  current  <  =-10) 
current =-10; 
end 


function  [Plnew, torque]  =hydralm(h, current, thetad,Pl,K, Dm, Vt,Ps,Ctm,eff,betae) 
% 

%  A  fourth-order  Runge-Kutta  method  is  used  to  obtain  the  numerical  solution 
%  In  this  case,  the  only  variable  will  be  PI 
% 

Pv  =  ’Ps  -  (Pl+x)’; 

Pld  =  ’(^'"betae/Vt)  ♦  (K*current*(sqrt(eval(Pv)))  -  Dm'^thetad  -  Ctm*(PH-x) )’; 

%  To  evaluate  kl,  let  x  =  0 
X  =  0; 

if  (eval(Pv))  <  0 
Pv  =  ’O’; 
end 

kl  =  h*eval(Pld); 

%  To  evaluate  k2,  let  x  =  kl/2 
X  =  kl/2; 
if  (eval(Pv))  <  0 
Pv  =  ’O’; 
end 

k2  =  h*eval(Pld); 

%  To  evaluate  k3,  let  x  =  k2/2 
X  =  k2/2; 
if  (evalfPv))  <  0 
Pv  =  ’O’; 
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end 

k3  =  h*eval(Pld); 

%  To  evaluate  k4,  let  x  =  k3 
X  =  k3; 

if  (eval(Pv))  <  0 
Pv  =  ’O’; 
end 

k4  =  h*eval(Pld); 

Plnew  =  PI  +  (l/6)*(kl  +  2*k2  +  2*k3  +  k4); 
ifPlnew  >  Ps 
Plnew  =  Ps; 
end 

ifPlnew  <  -Ps 
Plnew  =  -Ps; 
end 

torque  =  eff*'Plnew*Dm; 


function  [ps,pphi,pcurrent,ppsi]  =plotter(s,phi,current,psi,t) 
subplot(22 1)  ,plot(t,s)  ,xlabel(’Time(sec)  ’)  ,ylabel(’S  ’) 
subplot(22 1)  ,plot(t,phi)  ,xlabel(’Time(sec)  ’)  ,ylabel(’Phi’) 
subplot(221),plot(t, current), xlabel(’Time(sec)’),ylabel(’Current  (mA)’) 
subplot(221),plot(t,psi),xlalX5l(’Time(sec)’),ylabel(’Psi(Rad)’) 

*****************************************************************************:)i 


function  [D,Dd,w,wd,wdd, Ad,Add]  =usualm(tha,v,vd,L) 

D=[l  0  0;0  1  0;v  0  l];Dd=[0  0  0;0  0  0;vd  0  0]; 
w=[l  0  0;L*cos(tha)  cos(tha)  -sin(tha);L*sin(tha)  sin(tha)  cos(tha)]; 
wd=[0  0  0;-L*sin(tha)  -sin(tha)  -cos(tha);L*cos(tha)  cos(tha)  -sin(tha)]; 
wdd=[0  0  0;-L*cos(tha)  -cos(tha)  sin(tha);-L*sin(tha)  -sin(tha)  -cos(tha)]; 

Ad=[0  0  0;0  -sin(tha)  -cos(tha);0  cos(tha)  -sin(tha)]; 

Add=[0  0  0;0  -cos(tha)  sin(tha);0  -sin(tha)  -cos(tha)]; 

******************************************************i|,:t,4i*4,4,^4,^4,4i^4i«*^^4c^i„^4,4,^ 


function  ans  =  fa(v,vd,thetad,wd,wdd,Ad,Add,D,Dd, Ip, Ir,nlm,nlnlm,g, ml, torque) 

% 

%  evaluation  of  right  hand  side  of  the  large-motion  equation 
% 

%  (1)  -2*thetad*etad”^{integration  [N(x)’*W,’*W,*N(x)]dm}*eta 
%  where  {integration  [N(x)’*W,’*W,'*'N(x)]dm}=[nwwnl  nwwnl2;nwwnl2  nwwn2] 

X  =  -2*'thetad*'vd’^nlnlm*v; 
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%  (2,1)  {integration[s’]  dm}*W,’*g 

%  where  {integration[s’]  dm}  =  s  <--  1st  moment  of  inertia  of  link 
s  =  [4.856519  -2.428258693  0]; 
yl  =  s’*‘wd”*g; 

%  (2.2)  eta’*{integration[N’]  dm}*W,’*g 
%  where  { integration [N’]  dm}  =  n 

n  =  [0  0  nlm]; 

y2  =  v^n^wd’^g; 

%  (2.3)  {integration[Sp’]dm}*D’*W,”*g 

%  where  {integration[Sp’]  dm}  =  Sp  <-  1st  moment  of  inertia  of  payload 
Sp  =  [ml  0  0]; 
y3  =  Sp'*D”*'wd”*g; 
y  =  yH-y2+y3; 

%  (3)  evaluation  "trace"  terms  of  right  hand  side  of  large-motion  equation 

%  trace  [2*wd*D*Ip*Dd’*wd’]*thetad 

zll  =  -2'*‘thetad*wd'*‘D*Ip'"Dd”"wd’; 

z  =  trace(zll); 

ans  =  X -I- y-fz-f  torque; 


function  ans  =  fb(thetad,w,wd,D,Dd,nlm,Dv,Ip,g,ml) 

% 

%  evaluante  the  right  hand  side  of  the  small-motion  equation 
% 

%  (1)  {Integration  [N’]  dm}'"W’"‘g 
n  =  [0  0  nlm]; 
u  =  n"‘w*’"g; 
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%  (2) 

%  [  {integration  [Sp’]  dm}*Dv’*w’*g  {integration  [Sp’]  clm}*Dphi’*w’*g  ] 

%  where  {integration  [Sp’]  dm}  =  Sp 

Sp  =  [ml  0  OJ; 

X  =  Sp*Dv’*w’*g; 

%  (3) 

%  evaluate  all  the  "trace"  terms  of  right  hand  side  of  small-motion  equation 
% 

%  (3.1)  trace  [wdd*D*Ip’"Dv”"w’*(thetad"2))-l-2*wd*Dd’"Ip*Dv’*w’] 

yll  =  wd*Dv*Ip*D’*wd’*(thetad"2); 
y22  =  2*wd*Dv*Ip*Dd’*w”"(thetad); 
y  =  trace(yll-Hy22); 

ans  =  u+x-t-y;  %  sum  of  the  right  hand  side  of  small-motion  equation 


function  ans  =  maa(v,wd,Ad,D,Ip,Ir,swwsm,nlnlm,A,rho) 

%  % 

%  coefficient  computation  of  "thetadd"  of  large-motion  equation  % 

%  % 

%  (1)  {integration  [s”*'wd’*wd*s]  dm}  =  swwsm 
X  =  swwsm; 

%  (2)  eta’* {integration  [N’*wd’*wd*N]  dm}*eta 
y  =  v’*nlnlm*v;  %  2nd-order  value  should  be  small 

%  The  following  is  used  to  evaluate  all  the  "trace"  terms  in  the  coefl  1 
%  (2.1)  Trace  [  W,*D*Ip*D’*W,’  ] 
ul  =  trace(wd*D*Ip*D’*wd’); 

%  (2.2)  Trace  [  A,*Ir*A,  ] 
u2  =  trace(Ad*Ir*Ad’); 
z  =  ul+u2; 

ans  =  x-t-y+z; 


function  ans  =  mab(D,w,wd,Dv,Ip,lxnlm,ml,L) 

% 

%  coefficient  computation  of  "etadd"  of  large-motion  equation 
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% 

%  (1)  {integration  [s’*wd’*w*N]  dm}  =  [swwnl  swwn2] 

X  =  Ixnlm; 

%  (2)  [trace  (W,*D*Ip*(Dv)’*W’)  trace  (W,*D*Ip*(Dphi)’*W’)] 
y  =  trace(wd*D*Ip*Dv’*w’); 

ans  =  x+y; 

function  ans  =  mba(D,w,wd,Dv, Ip, Ixnlm) 

% 

%  coefficient  computation  of  "etadd"  of  large-motion  equation 
% 

%  (1)  (integration  [s’^wd’^w^N]  dm}  =  [swwnl  swwn2] 

X  =  Ixnlm; 

%  (2)  [trace  (W,*D*Ip*(Dv)’*W’)  trace  (W,*D*Ip-"(Dphi)’*W’)] 
y  =  trace(wd*D*Ip*Dv”*‘w’); 

ans  =  x-l-y; 

mm*mm*******m**’t‘*************************‘**********‘****‘*******************’**** 

function  ans  =  mbb(w,Dv,Ip,nlnlm,ml) 

% 

%  coefficient  computation  of  "etadd"  of  small-motion  equation 
% 

%  (1)  (integration  [N’^w^w^N]  dm}=  [nwwnl  nwwnl2;nwwnl2  nwwn2] 

X  =  nlnlm; 

%  (2)  [  Tr(W*Dv-Ip*Dv”"W’)  0;0  Tr(W*(Dphi)*Ip*(Dphi)’'"W’)  ] 
y  =  trace(w"‘Dv*Ip’*‘Dv’*w’); 

ans  =  x-J-y; 

function  ans  =  kb(thetad,klei, nlnlm) 

% 

%  coefficient  computation  of  "eta"  of  small-motion  equation 
% 

%  (1)  ((E'"I)/2)*(integartion  [sigma -t- sigma’]  dx}  =  x 
X  ==  klei; 

%  (2)  (integration  [N’*wd’*wd’"N)  dm}*eta*(thetad''2) 
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%  where  {integration  [N’*wd’*wd*N]  dm}  =  [nwwnl  nwwnl2;nwwnl2  nwwn2] 
y  =  -(thetad'^2)*nlnlm; 


ans=x+y; 

mmmm**m»***mm0mmmmmmmmmmmmmmmmm**********m****************************‘******** 


function  ans  =  nl(x,betal,beta2,Cl,C2,Bl,B2) 

% 

%  natural-mode  shape  functions  Nl(x)  evaluation 
% 

xil  =  Cl*(cos(betal*x)-t-cosh(betal*x))  (sin(betal*x)-t-sinh(betal*x)); 
xi2  =  C2*(cos(beta2*x)-f  cosh(beta2*x))  +  (sin(beta2'*x)-l-sinh(beta2*x)); 
ans  =  Bl^xil  +  B2'^xi2; 


function  ans  =  nlnl(x,betal,beta2,Cl,C2,Bl,B2) 

% 

xil  =  Cl’*(cos(betal*‘x)-l-cosh(betal*‘x))  (sin(betal*x)-fsinh(betal*x)); 
xi2  =  C2*(cos(beta2*x)-»-cosh(beta2*x))  (sin(beta2’*x)-l-sinh(beta2^x)); 

N1  =  Bl*xil  +  B2*xi2; 

%  ’nwwnl’  is  to  evaluate  NP2  and  to  be  used  in  "coefll.m" 

%  An  evaluation  of  [  NP2  N1*N2  ;  N1*N2  N2^2  ]  which  comes  from  multiplic- 
%  ation  of  [  N(x)’*W,’*W,*N(x)  ] 
ans  =  NL*2; 


function  ans  =  lxni(x,beial,beta2,Cl,C2,Bl,B2) 

xil  =  Cl*(cos(betal*x)+cosh(betal*x))  +  (sin(betal'^x)-t-sinh(betal*x)); 

xi2  =  C2’*‘(cos(beta2'*x)+cosh(beta2*x))  +  (sin(beta2*x)-l-sinh(beta2*x)); 

N1  =  Bl*xil  +  B2*xi2; 

ans  =  0.9985*N1  +  x.*Nl; 


function  y  =  swws(x,betal,beta2,Cl,C2,Bl,B2) 

% 

%  To  be  used  in  "coefll.m"  and  evaluate  integral  [S’^W.’^W.^Sldx 
%  After  multiplication  [  S’^W/^W/S  ]  =  (L-l-x)*2 
%  where  W  represents  2-D  homogeneous  transform  matrix 
%  W,  represents  first  derivative  w.r.t.  theta 
%  S  represents  the  local  position  along  the  link  [1  x  0]’ 
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%  L  length  of  the  link  =  0.9985  m 
% 

y  =  (0.9985 +x).*2; 


function  ans  =  kll(x,betal,beta2,Cl,C2,Bl.B2) 

xi  Idd = (betal  *betal)*(C  1 '^(-cos(betal '•‘x) +cosh(betal  *x)) + (-sin(betal  "^x) 
+sinh(betal’*‘x))); 

xi2dd = (beta2  *‘beta2)  ’^(C2  *(-cos(beta2  *x) + cosh(beta2‘*‘x))  -I-  (-sin(beta2*x) 
+sinh(beta2*x))); 

%  Note:  Nldd  =  second  derivative  of  Nl(x)  w.r.t.  x 
%  N2dd  =  second  derivative  of  N2(x)  w.r.t.  x 
Nldd  =  Bl-^xildd  +  B2-^xi2dd; 
ans  =  Nldd.''2; 
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APPENDIX  B 


FORTRAN  IMPLEMENTATION  PROGRAMS 


C  First-Order  Sliding  Condition  +  An  Integral  Error  Control 
SINCLUDE:  ’ATLDEFS.FOR’ 

SINCLUDE:  ’  ATLERRS.FOR’ 

PARAMETER  (NUM  =  1750) 

INTEGER-^2  ADGAINS(16),ADCHAN(16),ICONFIG(16),BASEADR,CDEVID, 
-hCDEVF,LG,SCAN,DAVALl,DAVAL2,Y,STATUS 
INTEGER^2  FH,FM,FS,FSS 

REAL  BHAT,FHAT,L, PI, K,R(3),G,IHAT,INTGERR, LAMBDA 

REAL  PSID(NUM) ,PSIVD(NUM) ,PSUERK(NUM) ,S(NUM),CURRENT(NUM) 

REAL  PSI(0:NUM),PHI(NUM) 

COMMON/CONFIG/ICONFIG 

EQUIVALENCE 

(ICONFIG(KCBASEADR),BASEADR),(ICONFIG(KCDEVID),CDEVID) 

-l-,(ICONFIG(KCDEVFLAGS),CDEVFLG),(lCONnG(KCSCAN),SCAN),(ICONnG(KCC 

-l-HANNELS),CHAN) 

C 

DATA  R,G/300.0,30.0, 1 .0,3000.0/, SPEED, L/10.0, 0.9985/ 

DATA  SMALFIL,INTGERR/2*0.0/,RATE,FREQ/2000.0,200.0/ 

DATA  PSUERK/NUM-"0.0/,PSIVOD,D20LD,VOLD/3*0.0/ 

C  UNCERTAINIES 

DATA  BHAT,DB/1.1E4,295.0/,FHAT,DF/-5.7732E4,6.7114E4/ 

C 

PRINT  *, ’Please  Enter  Lambda  for  S  dynamics,  and  Payload’ 

READ  '*,LAMBDA,PAyLOAD 

PRINT  ’Please  Enter  Desired  Trajectory  '’l'',or  "2"  ’ 

READ  ♦,IANS 
C  DESIRED  TRAJECTORY 
IF(IANS  .EQ.  1)  THEN 
DO  100M  =  1,NUM 
TIME = REAL(M)/FREQ 
IF  (TIME  .LE.  1.0)  THEN 
PSID(M)=TIME 
PSIVD(M)  =  1.0 

ELSE  IF((TIME  .Gc.  1.0)  .AND.  (TIME  .LE.  2.0))  THEN 
PSID(M)  =  1.0 
PSIVD(M)=0.0 
END  IF 

IF((TIME  .GT.  2.0)  .AND.  (TIME  .LE.  2.4))  THEN 
PSID(M)= 3.0-TIME 
PSIVD(M)=-1.0 
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ELSE  IF(TIME  .GE.  2.4)  THEN 
PSID(M)=0.6 
PSIVD(M)=0.0 
END  IF 

100  CONTINUE 

ELSE  IFaANS  .EQ.  2)  THEN 
DO  500  M  =  1,NUM 
PSID(M)  =  1.0 
PSIVD(M)=0.0 
PSUERK(M)=0.0 
500  CONTINUE 
END  IF 
C 

M=0 

PI=4*ATAN(1.0) 

PAR=PI/1054.0 
R1B  =  1.0/(R(3)*BHAT) 

RlNOM=SQRT(R(l)*’"2+R(2)*-"2+R(3)*»2) 

OPEN(UNIT=  15, FILE= ’C:\ATLAB\TMP\CTRL1  .M’, STATUS  = ’NEW’) 

C  INITIALIZE  DATA  ACQUSITION  BOARD 
STATUS  =  ALINIT0 
STATUS =ALSB(1) 

STATUS = ALSF(RATE) 

STATUS =ALRSET0 
STATUS =ALGCaCONFIG) 

STATUS =ALDV(0,Y) 

C 

WRITE(*,*)’  Are  you  ready  (Ctrl-C)  ?  ’ 

WRITE(*,*)’  When  you  are  ready  to  go,  press  "1"  and  "return"  ’ 

READ  *,IANS1 
IFaANS  1  .EQ.  1)  GOTO  7 
C  BEGIN  SIGNAL  PROCESSING 
7  CALL  GETTIMaH,IM,IS,ISS) 

5  STATUS = ALA V(l,l, DA VALl) 

STATUS = ALA  V(2, 1  ,DAVAL2) 

D1  =REAL(DAVAL  1-2048) 

D2  =REALa)AVAL2-2048) 

C  FILTERED  VERSION  OF  SMALL  MOTION  SIGNAL  COMING  OUT  FROM  STRAIN 
INDICATOR 

SMALFIL=0.94175*SMALFIL-I-0.029129*(D20LD-HD2) 

C  CALIBRATED  EQUATION  BETWEEN  DISPLACEMENT(cm)  AND  SMALFIL 
SMALL=-0.3*(SMALFIL+ 15) 

SMANG=SMALL/(100.0*L) 

C  LARGE  MOTION  CALIBRATED  EQUATION 
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THETA  =PAR*(Dl-30.0) 

C  TOTAL  ANGLE 

PSI(M)  =THETA+SMANG 
C  CONTROLLER  DESIGN 
IF(M  .EQ.  0)  GOTO  1 
POSERR =PSI(M)-PSID(M) 

INTGERR=POSERR/FREQ  +  INTGERR 
C  FILTERED  VERSION  OF  TOTAL  VELOCITY,  PSIV(M) 

VNEW = (PSI(M)-PSI(M- 1))  -"FREQ 

PSIV =0.980198*PSIVOD +0.00990099*(VOLD + VNEW) 

VELERR =PSIV-PSIVD(M) 

S(M)=R(l)*POSERR+R(2)-^VELERR+G*INTGERR 
C  NORMINAL  VALUE 

IHAT=R(l)*(-VELERR)+R(3)’^(PSUERK(M)-FHAT)-G*POSERR 
CTO  FIND  K 

K = (R1N0M*(DF +DB-"(R1B*IHAT)) + SPEED)/(1 .0-(DB*RlB)) 

PHI(M) = (K/LAMBDA)-"(1 .0+DB*RlB) 

STD=S(M)/PHI(M) 

IF(ABS(S(M))  XT.  PHI(M))  SAT=STD 
IF(ABS(S(M))  .GE.  PHI(M))  THEN 
IF(STD  .GE.  0.0)  SAT=1.0 
IF(STD  .LT.  0.0)  SAT=-1,0 
ENDIF 

CURRENT(M)=R1B*((IHAT  -  K*S AT)/ 1000.0) 

IF  (CURRENT(M)  .GE.  lO.OE-03)  CURRENT(M)  =  10.0E-03 
IF  (CURRENT(M)  .LE.  -lO.OE-03)  CURRENT(M)=-10.0E-03 
VOLT=CURRENT(M)*500.0 

C  DIGITAL  TO  ANALOG  (D/A)  CALIBRATED  EQUATION 
Y=NINT(((VOLT+9.9868)/4.8766)*1000.0) 

STATUS  =ALDV(0,Y) 

D20LD=D2 

VOLD=VNEW 

PSIVOD=PSIV 

C 

1  M=M+1 

IF  (  M  .LE.  NUM  )  GOTO  5 
WRITE(*,*)’Game  Over!’ 

CALL  GEmM(FH,FM,FS,FSS) 

C  RESET  D/A  BOARD 
Y=2048 

STATUS =ALDV(0,Y) 

STATUS =ALTERM0 

WRITE(15,*)’Lanibda=’,LAMBDA,’R  AND  G =’,R,G, ’Payload  =  ’, PAYLOAD 
DO  200  M=0,NUM-1 
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200  WRITE(15,25)CURRENT(M+  1),PSI(M),PSID(M+  1),S(M+  1),PHI(M  + 1) 

25  FORMAT(5F10.4) 

CLOSE(15) 

END 

4c  41 4c  *  *  4( « « itt  Dr  *  4c  4^  Kt «  « )|E  IK  )t(  4(  4t  41 41  III  *  ^  «  4c «  4c  4c  4c  He  lit  Kc  4^  4c  «  4c «  4c  *  ♦  Ik  *  itt  ifc  Incite  ]*£  Ik 

C  Straight  Sliding  Mode  Control 

SINCLUDE:  ’  ATLDEFS.FOR’ 

SINCLUDE:  ’  ATLERRS.FOR’ 

PARAMETER  (NUM  =  1000) 

INTEGER*2  ADG AINS(  1 6) , ADCH AN(  1 6),ICONFIG(  1 6) .BASEADR, CDEVID , 
+CDEVF, LG, SCAN, DAVALl, DA  VAL2,Y, STATUS 
INTEGER*2  FH,FM,FS,FSS 
C 

REAL  BHAT,FHAT,L,PI,K,R(3),IHAT 

REAL  PSIDCNUM)  ,PSI VD(NUM) ,  PSUERK(NUM) ,  S(NUM) ,  CURRENT(NUM) 

REAL  PSI(0:NUM),PSIV(0;NUM),INTGS 

COMMON/CONFIG/ICONFIG 

EQUIVALENCE 

aCONFIG(KCBASEADR),BASEADR),aCONFIG(KCDEVID),CDEVID) 

+  ,(ICONFIG(KCDEVFLAGS),CDEVFLG),aCONnG(KCSCAN),SCAN),(ICONnGCKCC 
+HANNELS),rHAN) 

C 

DATA  R/300.0,30.0,1.0/,SPEED,L/10.0,0.9985/ 

DATA  SMALL,SMALFrL/2*0.0/,RATE,FREQ/2000.0,200.0/ 

DATA  PSUERK/NUM*0.0/,PSIV(0),D20LD,VOLD,INTGS/4*0.0/ 

C  UNCERTAINIES 

DATA  BHAT,DB/1.1E4,295.0/,FHAT,DF/-5.7732E4,6.7114E4/ 

C 

PRINT  *, ’Please  Enter  Phi  AND  W  (Real  Number  Please)!’ 

READ  »,PHI,W 

PRINT  *, ’Please  Enter  Desired  Trajectory  "I"  or  ”2”  ’ 

READ  *,IANS 
C  DESIRED  TRAJECTORY 
IF(IANS  .EQ.  1)  THEN 
DO  100  M  =  1,NUM 
TIME = REAL(M)/FREQ 
IF  (TIME  .LE.  1.0)  THEN 
PSID(M)=TIME 
PSIVD(M)  =  1.0 

ELSE  IF((TIME  .GE.  1.0)  .AND.  (TIME  .LE.  2.0))  THEN 
PSID(M)  =  1.0 
PSIVD(M)=0.0 
END  IF 
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IF((TIME  .GT.  2.0)  .AND.  (TIME  .LE.  2.4))  THEN 
PSID(M)= 3. 0-TIME 
PSIVD(M)=-1.0 
ELSE  IF(TIME  .GE.  2.4)  THEN 
PSID(M)=0.6 
PSIVD(M)=0.0 
END  IF 

100  CONTINUE 

ELSE  IF(IANS  .EQ.  2)  THEN 
DO  500M=1,NUM 
PSID(M)  =  1.0 
PSIVD(M)=0.0 
PSUERK(M)=0.0 
500  CONTINUE 
END  IF 
C 

M=0 

PI=4*ATAN(1.0) 

PAR=PI/1054.0 

R1B=1.0/(R(3)*BHAT) 

RINOM =SQRT(R(1)*’"2  4-R(2)*-»2 -1-R(3)"‘*2) 

OPEN(UNIT=  15, FILE= ’C:\ATLAB\TMP\CTRL2.M’  .STATUS  =  ’NEW’) 

C  INITIALIZE  DATA  ACQUSITION  BOARD 
STATUS =ALINIT0 
STATUS =ALSB(1) 

STATUS = ALSF(RATE) 

STATUS =ALRSET0 
STATUS = ALGC(ICONFIG) 

STATUS =ALDV(0,Y) 

C 

WRITE(^,*)’  Are  you  ready  (Ctrl-C)  ?  ’ 

WRITE(*,*)’  When  you  are  ready  to  go,  press  "I"  and  "retum"  ’ 

READ  *,IANS1 
IF(IANS1  .EQ.  1)  GOTO  7 
C  BEGIN  SIGNAL  PROCESSING 
7  CALL  GETTIM(IH,IM,IS,ISS) 

5  STATUS = ALA V(l,l, DA VALl) 

STATUS =ALAV  (2, 1  ,DAVAU) 

D1  -REAL(DAVALl-2048) 

D2 =REAL(DAVAL2-2048) 

C  FILTERED  VERSION  OF  SMALL  MOTION  SIGNAL  COMING  OUT  FROM  STRAIN 
INDICATOR 

SMALFIL =0.94 1 75  ■^SMALFIL -1-0.029 1 29*(D20LD -I- D2) 

C  CALIBRATED  EQUATION  BETWEEN  DISPLACEMENT(cm)  AND  SMALFIL 
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SMALL=-1.0*(SMALFIL+15.0) 

SMANG=SMALU(100.0*L) 

C  LARGE  MOTION  CALIBRATED  EQUATION 
THETA = PAR*(D  1 -30. 0) 

C  TOTAL  ANGLE 

PSI(M)  =THETA-I-SMANG 
C  CONTROLLER  DESIGN 
IF(M  .EQ.  0)  GOTO  1 
POSERR =PSI(M)-PSID(M) 

C  FILTERED  VERSION  OF  TOTAL  VELOCITY,  PSIV(M) 

VNEW = (PSI(M)-PSI(M-1))*FREQ 

PSIV(M)=0.975309*PSIV(M-1)-I-0.01234568*(VOLD-I-VNEW) 
VELERR = PSI  V(M)-PSIVD(M) 

S(M)=R(l)*POSERR-l-R(2)*VELERR 
INTGS = INTGS  4-  (S(M)/FREQ) 

C  NORMINAL  VALUE 

IHAT=R(1)*(-VELERR)-I-R(3)*(PSUERK(M)-F^:.  .  ,-(0V**2)-"INTGS) 
C  TO  FIND  K 

K=(RlNOM*(DF-l-DB*(RlB-"IHA:)>-hSPEED)/(1.0-(DB*RlB)) 
LAMBD  A  =  (SQRT(  1+ DB-^R  I B))  *  W 
PHI(M) = (K/(2*ZETA*LAMbDA))*(DB*Rl  B) 

STD=S(M)/PHI(M) 

IF(ABS(S(M))  .LT,  PHI(M))  SAT=STD 
IF(ABS(S(M))  .GE.  PHI(M))  THEN 
IF(STD  .GE.  0.0)  SAT=1.0 
IF(STD  .LT.  0.0)  SAT=-1.0 
ENDIF 

CURRENT(M)=RlB*(aHAT  -  K-^S AT)/ 1000.0) 

IF  (CURRENT(M)  .GE.  lO.OE-03)  CURRENT(M)  =  10.0E-03 
IF  (CURRENT(M)  .LE.  -lO.OE-03)  CURRENT(M)=-10.0E-03 
VOLT=CURRENT(M) -*500.0 

C  DIGITAL  TO  ANALOG  (D/A)  CALIBRATED  EQUATION 
Y=NINT(((VOLT-l-9.9868)/4.8766)*1000.0) 

STATUS =ALDV(0,Y) 

D20LD=D2 

VOLD=VNEW 

C 

1  M=M-I-1 

IF  (  M  .LE.  NUM  )  GOTO  5 
WRITE(’*,-*)’Game  Over!’ 

CALL  GETTIM(FH,FM,FS,FSS) 

C  RESET  D/A  BOARD  AND  TERMINATION 
^=2048 

STATUS =ALDV(0,Y) 
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STATUS =ALTERMO 
WRrrE(15,*)’%R=’,R 
WRITE(15,*)’%PHI=’,PHI,’  W=’,W 

DO  200  M=0,NUM-1 

200  WRrrE(15,25)CURRENT(M  +  l),PSI(M),PSID(M+l),PSIV(M),S(M+l) 
25  F0RMAT(1X,5F12.4) 

CLOSE(15) 

END 


C  Versatile  Sliding  Mode  Control 
SINCLUDE;  ’  ATLDEFS  .FOR’ 

SINCLUDE;  ’  ATLERRS.FOR’ 

PARAMETER  (NUM=1000) 

INTEGER*2  ADGAINS(16),ADCHAN(16),ICONFIG(16),BASEADR,CDEVID, 
+CDEVF,LG,SCAN,DAVAL1,DAVAL2,Y,STATUS 
INTEGER-*2  FH,FM,FS,FSS 
C 

REAL  BHAT,FHAT,L,PI,K,R(3),G,fflAT 

REAL  PSID(NUM),PSIVD(NUM),PSUERK(NUM),SDOT(NUM),CURRENT(NUM) 
REAL  PSI(0:NUM),PSIV(0:NUM),INTGS,INTGERR 
COMMON/CONFIG/ICONFIG 
EQUIVALENCE 

aCONFIG(KCBASEADR),BASEADR),(ICONFIG(KCDEVID),CDEVID) 

+  ,(ICONFIG(KCDEVFLAGS),CDEVFLG),(ICONnG(KCSCAN),SCAN),aCONnG(KCC 
+HANNELS),CHAN) 

C 

DATA  R,G/300.0,30.0, 1 .0,  lOOO.O/SPEED.L/ 10.0,0.9985/ 

DATA  SMALL, SMALFIL,INTGERR/3*0.0/, RATE, FREQ/2000.0, 200.0/ 

DATA  PSUERK/NUM*0.0/,PSrV(0),S,D20LD,VOLD,INTGS/5*0.0/ 

DATA  SDOTO,SDOTN/2*0.0/ 

C  UNCERTAINIES 

DATA  BHAT,DB/1.1E4,295.0/,FHAT,DF/-5.7732E4,6.7114E4/ 

C 

PRINT  *, ’Please  Enter  Phi,  Wn,  AND  Z  (Real  Number  Please)!’ 

READ  •,PHI,W,Z 

PRINT  *, ’Please  Enter  Desired  Trajectory  "1"  or  "2"  ’ 

READ  *,IANS 
C  DESIRED  TRAJECTORY 
IFGANS  .EQ.  1)  THEN 
DO  100M  =  1,NUM 
TIME=REAL(M)/FREQ 
IF  (TIME  .LE.  1.0)  THEN 
PSID(M)=TIME 
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PSIVD(M)  =  1.0 

ELSE  IF((TIME  .GE.  1.0)  .AND.  (TIME  .LE.  2.0))  THEN 
PSID(M)  =  1.0 
PSIVD(M)=0.0 
END  IF 

IF((TIME  .GT.  2.0)  .AND.  (TIME  .LE.  2.4))  THEN 
PSID(M)= 3. 0-TIME 
PSIVD(M)=-1.0 
ELSE  IF(TIME  .GE.  2.4)  THEN 
PSID(M)=0.6 
PSIVD(M)=0.0 
END  IF 

100  CONTINUE 
ELSE 

DO  300  M  =  1,NUM 
TIME=REAL(M)/FREQ 
PSID(M)  =  1.0 
PSIVD(M)=0.0 
C  PSIAD(M)=0.0 
PSUERK(M)=0.0 
300  CONTINUE 
ENDIF 
C 

M=0 

PI=4»ATAN(1.0) 

PAR=PI/1054.0 

R1B=1.0/(R(3)*BHAT) 

RlNOM=SQRT(R(l)-»*2+R(2)’"*2-i-R(3)**2) 

OPEN(UNIT=15,FILE=’C:\ATLAB\TMP\CTRL3.M’,STATUS  =  ’NEW’) 
C  INITIALIZE  DATA  ACQUSITION  BOARD 
STATUS =ALINIT0 
STATUS =ALSB(1) 

STATUS = ALSF(RATE) 

STATUS  =  ALRSET0 
STATUS  =  ALGCaCONFIG) 

STATUS =ALDV(0,Y) 

C 

WRITE('*,U’  Are  you  ready  (Ctrl-C)  ?  ’ 

WRITE(*,*)’  When  you  are  ready  to  go,  press  "1"  and  "return"  ’ 

READ  *,IANS1 
IFaANSl  .EQ.  1)  GOTO  7 
C  BEGIN  SIGNAL  PROCESSING 
7  CALL  GETnMaH,IM,IS,ISS) 

5  STATUS = ALA V(l,l, DA VALl) 
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STATUS =ALAV(2, 1  ,DAVAL2) 

D1  =REAL(DAVALl-2048) 

D2 =REAL(DAVAU-2048) 

C  FILTERED  VERSION  OF  SMALL  MOTION  SIGNAL  COMING  OUT  FROM  STRAIN 
INDICATOR 

SMALFIL=0.94175*SMALFIL+0.029129*(D20LD+D2) 

C  CALIBRATED  EQUATION  BETWEEN  DISPLACEMENT(cm)  AND  SMALFIL 
SMALL=-1.0*(SMALFIL+ 15.0) 

SMANG =SMALL/(100.0*L) 

C  LARGE  MOTION  CALIBRATED  EQUATION 
THETA =PAR*(D  1-30.0) 

C  TOTAL  ANGLE 

PSI(M)  ==THETA-HSMANG 
C  CONTROLLER  DESIGN  (VERSATILE) 

IF(M  .EQ.  0)  GOTO  1 
POSERR=PSI(M)-PSID(M) 

INTGERR=INTGERR  +  POSERR/FREQ 
C  FILTERED  VERSION  OF  TOTAL  VELOCITY,  PSIV(M) 

VNEW = (PSI(M)-PSI(M-  1))*FREQ 

PSIV(M)=0.975309*PSIV(M-1)+0.01234568*(VOLD+VNEW) 

VELERR =PSIV(M)-PSIVD(M) 

SDOTN=R(l)*POSERR+R(2)*VELERR-l-G*INTGERR-Z*S 
SDOT(M)=0.94175*SDOT(M-1)+0.029129*(SDOTO+SDOTN) 
S=S+SDOT(M)/FREQ 
C  NORMINAL  VALUE 

IHAT=R(l)*(-VELERR)-l-R(3)*(PSUERK(M)-FHAT)-G*POSERR-f-Z*SDOT(M) 

+.((W*>^)*S) 

CTO  FIND  K 

K = (R1N0M*(DF +DB*(R1B*IHAT)) +SPEED)/(1 .0-(DB*RlB)) 

LAMBDA =(SQRT(1  -I-DB*R1B))*W 

PHI(M) = (K*(DB*R1B))/((2*ZETA*LAMBDA) -I- (DB*R1B*Z)) 

C 

STD =SDOT(M)/PHI(M) 

IF(ABS(SDOT(M))  .LT.  PHI(M))  SAT = STD 
IF(ABS(SDOT(M))  .GE.  PHI(M))  THEN 
IF(STD  .GE.  0.0)  SAT=1.0 
IF(STD  .LT.  0.0)  SAT=-1.0 
ENDIF 

CURRENT(M)=R1B*((IHAT  -  K*SAT)/1000.0) 

IF  (CURRENT(M)  .GE.  lO.OE-03)  CURRENT(M)  =  10.0E-03 
IF  (CURRENT(M)  .LE.  -lO.OE-03)  CURRENT(M)=-10.0E-03 
VOLT=CURRENT(M)*500.0 

C  DIGITAL  TO  ANALOG  (D/A)  CALIBRATED  EQUATION 
Y=NINT(((VOLT-»-9.9868)/4.8766)*1000.0) 
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STATUS =ALDV(0,Y) 

D20LD=D2 

VOLD=VNEW 

SDOTO=SDOTN 

C 

1  M=M+1 

IF  (  M  .LE.  NUM  )  GOTO  5 
WRITE(*,*)  ’Game  Over  !’ 

CALL  GEmM(FH,FM,FS,FSS) 

C  RESET  D/A  BOARD  AND  TERMINATION 
Y=2048 

STATUS =ALDV(0,Y) 

STATUS =ALTERM0 
WRITE(15,*)’%R=’,R 
WRITE(15,’^)’%G  =  ’,G 

WRITE(15,*)’%PHI=  W=  ’,W,’  Z=  ’,Z 

DO  200  M=0,NUM-1 

200  WRITE(15,25)CURRENT(M+l),PSI(M),PSID(M  +  l),PSIV(M),SDOT(M+l) 
25  F0RMAT(1X,5F12.4) 

CLOSE(15) 

END 


1 
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